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ABSTRACT 


In  1923,  Hennan  Oberth,  considered  by  some  to  be  “the  father  of  it  all”  for 
spaceflight,  wrote  a  book  called  “ Die  Rcikete  zu  den  Planetrdumen”  (i.e.,  “Dreams  of 
Planets”)  inspiring  today’s  modem  spaceflight.  Amongst  his  suggestions  was  placing  a 
telescope  in  space,  so  astronomical  observations  may  be  made  without  atmospheric 
distortion.  Nearly  a  century  later,  the  Hubble  Space  telescope  is  imaging  distant  stars 
with  high  accuracy.  If  Hubble  were  placed  on  the  ground  of  the  West  Coast  of  the  United 
States,  it  would  able  to  target  a  small  coin  placed  on  the  Lincoln  memorial  on  the  East 
Coast  of  the  United  States.  This  startling  accuracy  has  become  useful  for  military 
spacecraft  missions  as  well  even  though  the  mission  is  much  more  challenging.  Military 
spacecraft  perfonn  aggressive  slew  maneuvers  to  acquire  targets,  but  the  actuators  are 
complicated  by  singularities  that  can  often  lead  to  loss  of  attitude  control  during 
aggressive  maneuvers.  After  acquiring  the  target,  the  spacecraft  must  rapidly  settle  and 
track  the  target  as  the  spacecraft  races  by  overhead. 

This  dissertation  addresses  these  challenges  by  introducing  a  new  optimized 
geometry  for  installation  of  the  spacecraft  actuators  to  minimize  the  impact  of 
singularities.  Methods  are  discussed  to  orient  the  direction  of  maximum  slew  capability 
in  a  desired  direction.  In  addition  to  the  optimal  geometry,  a  new  algorithm  is  presented 
that  reduces  those  remaining  singularities  that  could  lead  to  loss  of  attitude  control.  A 
newly  developed  algorithm  is  proven  to  fly  through  the  singularities  without  losing 
attitude  control.  The  advancements  introduced  here  increase  aggressive  maneuver 
performance  aiding  military  spacecraft  rapidly  acquire  earthly  targets. 

After  acquiring  the  target,  several  new,  very  simple  adaptive  control  algorithms 
are  introduced  that  adjust  the  control  strategy  based  on  tracking  errors.  If  the  spacecraft 
has  trouble  tracking  a  target,  the  control  is  adjusted  to  eliminate  the  tracking  error.  Using 
simplified  techniques,  target  tracking  accuracy  is  increased  compared  to  current 
spacecraft  control  methods.  While  many  promising,  advanced  techniques  look  good  on 
paper,  real-world  factors  like  noisy  signals  and  disturbances  are  often  confounding.  Most 
importantly,  the  claims  made  here  are  proven  experimentally  on  a  free-floating  spacecraft 
simulator. 
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I.  INTRODUCTION 


A.  MOTIVATION 

Military  satellites  face  unique  challenges  performing  their  mission.  The  civilian 
Hubble  Space  Telescope[l]  needs  to  point  extremely  accurately  (within  an  accuracy  of 
0.007  arc-seconds  =  0.034  /n/cra-radians  or  1.94  micro- degrees)  to  take  pictures  of 
distance  objects.  It  achieves  this  level  of  accuracy  by  staring  fixed  in  inertial  space 
controlled  by  four  reaction  wheels.  Large  slews  between  targeted  objects  are  performed 
by  reaction  wheels  over  as  much  as  much  as  9-20  minutes  with  considerable  settling  time 
pennitted  for  target  tracking  [2].  Reaction  wheels  are  low  torque  devices  that  provide 
torque  by  absorbing  momentum  by  increasing/decreasing  wheel  rotation  speed.  Military 
spacecraft  on  the  other  hand  may  slew  from  one  target  to  another  several  times  in  one 
orbital  pass  and  cannot  take  20  minutes  to  accomplish  maneuvers.  Military  satellites  must 
reconnoiter  multiple  points  in  a  given  orbital  pass  (as  little  as  10  minutes).  Minimization 
of  target  acquisitions  time  is  a  critical  requirement. 

While  current  and  future  mission  requirements  are  driving  Hubble-like  pointing 
accuracy,  military  operational  requirements  demand  large  angle,  rapid  slew  maneuvers  as 
quickly  as  possible  and  also  require  quick  settling  with  minimal  target  tracking  errors. 
Consider  a  military  spacecraft  simply  taking  pictures.  After  achieving  a  rapid  target 
acquisition  slew,  blurry  images  will  result  if  tracking  errors  are  large. 
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Figure  1  Hubble  Space  Telescope  [2]. 
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The  military  spacecraft  mission  of  rapidly  acquiring  and  accurately  tracking  a 
terrestrial  or  space-based  target  is  often  referred  to  as  acquisitions,  tracking  and  poin  ting 
(ATP).  Civilian  spacecraft  are  not  typically  designed  for  such  missions,  but  military 
spacecraft  often  must  perfonn  these  missions  despite  their  shared  design  heritage.  Even 
considering  a  rigid  spacecraft,  rapid  maneuvers  with  quick  settling  time  and  fine  target 
tracking  are  quite  challenging.  Systematically  consider  rapid  slew  maneuvers  as  one 
challenge  and  target  tracking  as  a  second  challenge. 

1.  Fast  Target  Acquisitions  Maneuvers 

The  rapid  slew  maneuver  often  drives  spacecraft  to  utilize  high-torque  actuators 
like  thrusters  and  control  moment  gyroscopes  (CMGs).  While  thrusters  have  finite  fuel 
that  is  easily  depleted,  CMGs  are  momentum  exchange  devices  that  trade  momentum 
back  and  forth  with  the  spacecraft  without  exhaustion.  Unlike  the  reaction  wheel  that 
spins  up/down  to  deliver  relatively  low  torque,  the  wheel  spins  in  the  CMG  at  a  constant 
rate  creating  a  large  momentum  vector.  Momentum  changes  result  when  the  spinning 
CMG  wheel  is  gimbaled  (single  or  double  gimbal)  generating  rapid  spacecraft  reaction 
torques.  Since  angular  momentum  of  the  entire  spacecraft  system  is  conserved,  changes 
in  CMG  momentum  must  result  in  corresponding  changes  in  spacecraft  momentum  to 
maintain  system  equilibrium. 

Despite  desirable  traits,  CMGs  suffer  from  mathematical  singularities  that 
severely  limit  the  achievable  torque  with  typical  control  algorithms  risking  loss  of 
attitude  control.  Singularities  may  be  physically  defined  as  the  inability  to  generate  a 
desired,  arbitrary  torque  (the  dilemma).  The  mission  demands  inexhaustible,  repeated 
rapid  maneuvers  in  minimum  time.  This  dictates  the  use  of  control  moment  gyroscopes, 
but  singularities  can  result  in  complete  loss  of  attitude  control.  While  a  minimum  of  three 
single-gimbaled  CMGs  (SGCMGs)  are  required  for  three-axis  control,  spacecraft 
designers  currently  use  more  than  three  SGCMGs  to  afford  themselves  extra  degrees  of 
freedom  to  implement  singularity  avoidance  schemes  in  hopes  of  avoiding  lost  attitude 
control. 

Additionally,  consider  that  CMG  rotor  wheels  must  spin  at  all  times,  thus  failures 
are  very  common.  The  International  Space  Station  uses  a  four  CMG  array  and 
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experienced  its  first  CMG  failure  on  June  8,  2002,  after  about  1.5  years  of  operation[3]. 
Despite  this  failure,  the  ISS  must  still  insure  safety  during  nonnal  operations,  Space 
Shuttle  rendezvous,  and  repair  operations. 

With  relatively  sparse  research  using  only  three  SGCMGs,  post-failure  attitude 
control  with  CMGs  is  very  challenging.  Most  commonly,  the  singularity-free  momentum 
space  is  determined  for  the  given  geometric  installation  of  the  CMGs.  Momentum 
management  dominates  attitude  control  requiring  engineers  to  keep  maneuvers  below  the 
singularity-free  threshold  for  safety’s  sake.  Military  missions  must  be  prepared  to 
operate  with  three  SGCMGs  despite  the  sparseness  of  research  in  the  literature  for  three 
CMGs. 

With  this  backdrop,  this  thesis  entails  current  research  to  optimize  the  three  CMG 
array  to  give  maximum  momentum  for  minimum  time  slew  maneuvers.  Furthermore  the 
use  of  dissimilar  skew  angles  (aka  “mixed  skew  angles)  pennits  us  to  place  the  direction 
of  maximum  momentum  in  desired  directions.  Virtually  no  research  was  found  for 
CMGs  using  mixed  skew  angles.  Finally,  two  new  techniques  are  developed  to  reduce 
singularities  remaining  in  the  optimum  geometry  and  even  to  penetrate  the  singularities 
without  loss  of  attitude  control.  These  new  techniques  have  the  potential  to  bestow 
worry-free  aggressive  maneuvering  capability  to  military  spacecraft. 

The  first  volume  of  research  presented  in  this  thesis  addresses  minimum  time  slew 
maneuvers,  but  that  only  solves  half  of  the  problem.  After  slewing  to  the  new  target  area 
in  minimal  time,  military  spacecraft  must  quickly  settle  and  begin  fine  target  tracking. 

2.  Fine  Target  Tracking 

Target  tracking  is  complicated  by  inaccuracies  in  estimated  spacecraft  inertia. 
Typical  design  techniques  for  controlling  rigid  spacecraft  use  an  assumed  inertia  or  an 
inertia  experimentally  determined  on  the  ground.  Consider  the  depicted  satellite  as  a 
simple  point  of  mass  M  and  inertia  J.  If  the  inertia  is  known  a  perfect  control  torque 
^control  is  easily  expressed  for  an  inertial  rotational  maneuver  per  Newton’s  Law  written 
for  rotations  (aka  “Newton-Euler”):  Tcontroi  =  (inertia)  X  (inertial  rotational  acceleration). 
For  a  desired  inertial  rotational  acceleration,  this  is  the  “perfect  feedforward”  control.  If 
the  inertia  were  exact,  no  tracking  errors  would  be  incurred  in  the  absence  of  external 
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disturbance  torques.  Since  inertia  is  not  exactly  known,  feedback  control  is  also  used  to 
add  control  commands  based  on  the  already-incurred  tracking  error. 


After  a  spacecraft  reaches  it’s  orbit,  considerable  time  and  effort  are  expended  on 
system  identification  to  obtain  good  values  for  inertia  to  aid  future  attitude  control.  Fuel 
expenditure  during  orbital  insertion  and  during  orbit  maintenance  in  addition  to  gimbaled 
appendages  make  accurate  inertia  estimates  a  continual  challenge  for  distant  spacecraft. 
Nonetheless,  more  accurate  inertia  models  yield  better  spacecraft  control. 

In  the  early  1990s,  researchers  introduced  nonlinear  adaptive  control  techniques 
to  estimate  on-orbit  spacecraft  inertia  values  using  tracking  errors.  The  updated  inertia 
was  used  to  formulate  the  controls  and  a  reference  trajectory  was  also  utilized  in  both 
feedforward  and  feedback  controls  to  further  reduce  tracking  errors[43].  The  method  was 
completely  derived  for  three-dimensional  rotational  spacecraft  maneuvers  and 
simulations  demonstrated  superior  tracking  only  when  compared  to  feedback  control 
alone[44].  Comparisons  were  not  made  with  combined  classical  feedforward  plus 
feedback  control  (arguably  the  most  common  approach  used  today).  The  adaptive 
technique  was  formulated  in  the  inertial  reference  frame  and  resulted  in  unwieldy 
calculations.  For  expensive  spacecraft  missions,  computer  memory  is  a  precious 
commodity.  Complicated  algorithms  that  require  high  amounts  of  computer  memory 
must  provide  comparable  performance  increase  to  justify  consideration. 

Shortly  afterwards,  a  subsequent  researcher  suggested  algorithmic  simplification 
by  formulating  the  technique  in  the  body  reference  frame[46].  The  method  was  derived 
for  a  three-dimensional  example  of  slip-translational  motion  of  the  Space  Shuttle  (not 
rotational  spacecraft  maneuvers),  and  no  comparative  simulations  were  presented.  This 
method  seems  quite  promising  for  spacecraft  attitude  control  ( rotational  spacecraft 
maneuvers)  as  it  applies  to  acquisitions,  tracking,  and  fine  pointing.  A  substantial 
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development  presented  here  derives  the  later  method  in  the  body  frame  for  spacecraft 
rotational  maneuvers.  Simulations  and  experimental  comparisons  are  made  to 
proportional-derivative  (PD)  feedback  alone,  and  combined  classical  feedforward- 
feedback  control.  Additionally,  several  improvements  are  suggested  further  improving 
performance.  While  the  methods  in  the  literature  formulate  both  feedforward  and 
feedback  adaptive  controls  utilizing  a  reference  trajectory,  perfonnance  improvement  is 
demonstrated  using  the  reference  trajectory  only  for  the  feedforward  control  maintaining 
typical  PD  feedback  controls  using  the  desired  trajectory.  It  is  further  shown  that 
estimation  dynamics  can  be  completely  eliminated  while  maintaining  significantly 
improved  target  tracking  performance.  Lastly,  two  algorithmic  simplifications  are 
introduced  and  compared  in  simulations  and  experiments. 

Taken  all  together  this  dissertation  entails  some  latest  additions  to  ATP  research 
demonstrating  significant  improvements  to  spacecraft  slew  maneuvers  and  tracking. 
Relatively  greater  improvements  are  achieved  during  slew  maneuvers  with  further 
modest  improvements  during  target  tracking.  Special  attention  is  brought  to  the 
significance  of  considerable  experimental  work.  Many  promising  advanced  control 
techniques  exist,  but  until  they  are  proven  to  work  experimentally  program  managers  of 
space  missions  will  be  reluctant  to  utilize  these  advanced  techniques. 

Experimentation  is  difficult  and  can  often  frustrate  the  most  seemingly  simple 
algorithm.  Real  world  systems  (including  spacecraft)  are  noisy  and  rarely  behave  exactly 
as  predicted  by  simplified  models.  This  thesis  only  contains  research  that  has  been 
experimentally  verified  on  a  free-floating  spacecraft  simulator.  The  proposed  advanced 
control  algorithms  for  target  tracking  and  the  control  moment  gyroscope  developments 
for  rapid  slew  will  be  proven  effective  with  analytic  argument  followed  by  simulations 
and  experimental  verification. 

B.  LITERATURE  REVIEW 

1.  Control  Moment  Gyroscopes  for  Rapid  Slew  Maneuvers 

Despite  singularity  issues,  CMG  research  began  in  1960s  for  large  satellites  like 
SKYLAB  (which  used  three  dual  gimbaled  CMGs  or  DGCMGs)[7].  Computers  of  the 
time  could  not  perfonn  matrix  inversion  in  real  time.  Simple  systems  that  did  not  require 
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matrix  inversion  were  an  obvious  choice.  Otherwise  algorithmically  simple 
approximations  must  have  been  available  for  the  system  chosen.  Singularity  avoidance 
was  researched  a  lot  in  the  1970s  and  1980s. [8]-[14] 


Singularity  avoidance  was  typically  done  using  a  gradient  method  and  double 
gimbaled  CMGs[l  1],[12],  These  gradient  methods  are  not  effective  for  Single  Gimbaled 
CMGs  (SGCMGs)  like  they  are  for  Double  Gimbaled  CMGs  (DGCMGs).  Margulies 
was  first  to  formulate  a  theory  of  singularity  and  control  [13]  including  the  geometric 
theory  of  singular  surfaces,  generalized  solution  of  the  output  equation,  null  motion 
(using  greater  than  three  SGCMGs),  and  the  possibility  of  singularity  avoidance  for 
general  SGCMG  systems.  Also  in  1978  Russian  researcher  Tokar  published  singularity 
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surface  shape  description,  size  of  workspace,  and  considerations  of  gimbal  limits[14], 
Kurokawa  identified  that  a  system  such  as  a  pyramid  type  SGCMG  system  will  contain 
an  impassable  singular  surface  and  concluded  systems  with  no  less  than  6  units  provide 
adequate  workspace  free  of  impassable  singular  surfaces[15].  The  MIR  space  station  was 
designed  for  6  SGCMG  operations.  This  thesis  will  evaluate  singularity-free  operations 
using  a  mere  three  CMG  array  and  continue  to  reduce  singularities,  then  penetrate  those 
remaining  singularities. 

Continued  research  aimed  at  improving  results  with  less  than  6  CMGs 
emphasized  a  4  CMG  pyramid[17].  Much  research  resulted  in  gradient  methods  that 
regard  passability  as  a  local  problem  that  proved  problematic  [14], [16], [18].  Global 
optimization  was  also  attempted  but  proved  problematic  in  computer  simulations[20]. 
Difficulties  in  global  steering  were  also  revealed  in  ref[21].  Reference  [22]  compared  six 
different  independently  developed  steering  laws  for  pyramid  type  single  gimbaled  CMG 
systems.  The  study  concluded  that  that  exact  inverse  calculation  was  necessary  (the  exact 
inverse  calculation  will  be  used  in  this  thesis).  Other  researchers  addressed  the  inverted 
matrix  itself  adding  components  that  make  the  matrix  robust  to  inversion  singularity 
[23], [24], [25]  as  extensions  of  the  approach  to  minimize  the  error  in  generalized  inverse 
Jacobian  calculation  [26],  These  approaches  introduce  tracking  error  where  necessary  to 
avoid  singularities  by  following  a  different  momentum  path  (generating  other-than- 
desired  torque).  The  generalized  singularity-robust  inverse  from  ref  [23]  was  initially 
utilized  in  this  research  for  comparative  purposes,  and  the  results  will  be  discussed. 

This  thesis  will  investigate  exactly  following  the  commanded  path  rather  than  a 

path  that  avoids  singularities  to  minimize  slew  time.  Momentum  path  planning  is  another 

approach  used  to  attempt  to  avoid  singularities  that  can  also  achieve  optimization  if  you 

have  knowledge  of  the  command  sequence  in  the  near  future  [26], [34], [35],  Another 

method  used  to  avoid  singularities  is  to  use  null  motion  to  first  reorient  the  CMGs  to 

desired  gimbal  positions  that  are  not  near  singular  configurations  [36].  By  definition,  null 

motion  is  motion  of  the  CMGs  that  result  in  a  net  zero  torque.  Null  motion  only  exists 

when  more  than  three  SGCMGs  are  used.  The  extra  degrees  of  freedom  provided  by  a 

configuration  with  more  than  three  SGCMGs  are  used  to  execute  the  null  motion.  Since 

this  research  is  perfonned  under  the  auspices  of  the  Naval  Postgraduate  School’s  bifocal 
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relay  spacecraft  project,  it  is  important  to  note  most  recently  ref  [30]  reports  on  an 
analytical-numerical  study  of  the  complete  symbolic  expression  of  the  equations  of 
motion  of  a  dual-body  spacecraft,  including  standard  singularity  avoidance  methods  and 
analysis  of  robustness  against  inertia  uncertainties.  Both  singularity  avoidance  and 
inertia  uncertainty  play  pre-eminent  roles  in  the  research  summarized  in  this  dissertation. 

Despite  the  massive  amount  of  research  done  on  CMGs,  precision  control  with 
CMGs  (especially  only  three  SGCMGs)  is  still  an  unsolved  problem  [31], [33], [35]. 

2.  Adaptive  Spacecraft  Control  for  Fine  Target  Tracking 

Adaptive  control  techniques  adapt  control  commands  based  upon  errors  tracking 
trajectories  and/or  estimation  errors.  Direct  adaptive  control  techniques  directly  adapt  the 
control  signal  without  explicit  estimation  of  system  parameters.  The  control  is 
reparameterized  in  terms  of  the  parameters  so  that  the  estimates  need  not  be  translated 
into  the  control  parameters  after  estimation  [44].  On  the  other  hand  indirect  adaptive 
control  techniques  indirectly  adapt  the  control  signal  on  the  basis  of  estimates  of  the  plant 
parameters.  The  plant  parameters  are  explicitly  estimated,  then  translated  into  the  control 
separately  [44].  The  adaptation  rule  is  derived  in  order  to  guarantee  rapid  elimination  of 
tracking  errors  (the  true  objective)  and  global  stability  of  the  nonlinear  closed  loop 
system.  Two  fields  of  application  of  adaptive  control  is  robotic  manipulators  and 
spacecraft  maneuvers  utilizing  both  approaches[38][39][40]. 

While  some  adaptive  techniques  concentrate  on  adaptation  of  the  feedback 
control,  others  have  been  suggested  to  modify  a  feedforward  control  command  retaining 
a  typical  feedback  controller,  such  as  Proportional-Derivative  (PD).  Anderson  evaluated 
the  filtered-x  LMS  algorithm  with  FIR  estimation  for  adaptation  of  feedforward 
command  signals[41].  Simpler  adaptation  rules  have  been  used  for  adaptation  of  the 
control  signal  in  the  inertial  reference  frame [42].  Hamiltonian  Adaptive  Control  of 
Spacecraft  [43]  presents  such  an  inertial  frame  adaptive  control.  While  the  adaptation  is 
simpler  in  general  form,  the  resulting  regression  model  used  in  the  control  signal  requires 
several  pages  to  express  for  three-dimensional  spacecraft  rotational  maneuvers  (included 
in  the  appendix).  This  key  reference  presents  a  starting  point  for  the  research  presented 
here.  Other  references  also  utilizing  the  inertial  frame [44]  have  been  extended  to  include 


8 


attitude  control  system  power  tracking  in  the  control  signal[45],  but  still  suffer  from  the 
algorithmic  complexity  that  accompanies  the  inertial  frame.  The  measured  regression 
matrix  of  “knowns”  is  required  in  the  control  calculation,  so  this  approach  is 
computationally  inappropriate  for  spacecraft  rotational  maneuvers.  Subsequently, 
Slotine’s  9-parameter  estimation  general  approach  [43]  was  suggested  for 
implementation  in  the  body  reference  frame  by  Fossen[46].  The  method  was  derived  for 
slip  translational  motion  of  the  space  shuttle,  but  neither  simulated  nor  experimentally 
verified.  Nonetheless,  this  method  appears  promising  for  practical  implementation  for 
three-dimensional  spacecraft  rotational  maneuvers.  Successful  implementation  could 
lead  to  improved  target  tracking  accuracy  with  reduced  tracking  errors.  System 
performance  is  enhanced  by  1)  updated  inertia  in  the  feedforward  control  signal,  and  2) 
use  of  a  reference  trajectory  that  alters  the  desired  trajectory  in  both  feedforward  and 
feedback  using  the  tracking  error.  Adaptive  controllers  have  become  notorious  since  the 
1960’s  and  1970s  for  instability.  In  1966  Michael  James  Adams  was  killed  when  his  X- 
15  aircraft  was  tom  apart  due  to  his  adaptive  control  system[47],[48].  The  X-15  entered  a 
divergent  spiral  as  the  adaptive  controller  estimates  diverged  [49].  Accordingly,  great 
efforts  are  exerted  in  this  research  to  simplify  the  estimation  and  eventually  eliminate 
estimation  altogether. 

The  9-parameter  Slotine-Fossen  approach  will  be  derived  for  3-dimensional 
spacecraft  rotational  maneuvers.  Estimation  requirements  will  be  reduced  with  new  6- 
parameter  and  3 -parameter  regression  models.  Finally  a  modification  to  the  approach 
demonstrates  improved  perfonnance  maintaining  simplified  regression  models  by  not 
using  the  reference  trajectory  in  the  feedback  signal.  Finally,  elimination  of  estimation 
will  be  achieved  without  sacrificing  tracking  perfonnance.  After  promising  simulations, 
experimental  verification  is  performed  on  a  free-floating,  three-axis  spacecraft  simulator. 
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C.  THESIS  OVERVIEW 

With  this  review  of  the  literature,  unique  contributions  in  this  thesis  may  be 
summarized: 

1.  Development  of  the  optimal  geometry  for  skewed  arrays  of  only  three  single- 
gimbaled  control  moment  gyroscopes  resulting  in  maximum  singularity-free 
momentum  space, 

2.  the  direction  of  maximized  singularity-free  momentum  may  be  rotated  to  a 
desired  direction  utilizing  mixed  skew  angles, 

3.  further  singularity  reduction  using  a  new  decoupled  control  steering  technique, 

4.  development  of  a  simple,  yet  effective  singularity  penetration  method  to  deal  with 
the  residual  singular  states  remaining  in  the  momentum  space 

5.  derivation  of  a  9-parameter  adaptive  control  technique  suggested  in  the  literature 
for  spacecraft  rotational  maneuvers  including  critical  comparison  to  the  most 
effective  control  methods  currently  used  for  spacecraft  via  simulations  and 
experimentation, 

6.  parameter  estimation  reduction  (6-parameter)  resulting  in  equivalent,  simpler 
adaptive  control  algorithms  with  inertia  estimation 

7.  further  parameter  estimation  reduction  (with  valid  assumptions)  leading  to  3- 
parameter  adaptive  control, 

8.  introduction  of  a  new  alternative  adaptive  control  algorithm  further  reducing 
target  tracking  errors  (eliminate  reference  trajectory  from  the  feedback  instead 
using  desired  trajectory  in  a  PD  feedback  architecture), 

9.  demonstration  that  estimation  may  be  eliminated  in  the  approaches  studied 
simplifying  the  control  algorithms. 

A  comprehensive  theoretical  development  is  now  appropriate.  Theoretical 
development  is  organized  topically.  The  first  topic  to  be  addressed  is  high-torque,  rapid 
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spacecraft  slew  acquisitions  maneuvers.  Afterwards,  adaptive  feedforward  control  for 
improved  target  tracking  accuracy  is  presented.  Both  topics  include  simulations  to 
illustrate  the  theory. 

Afterwards,  a  detailed  description  of  the  experimental  hardware  is  provided  to 
allow  duplication  of  the  results  presented  here.  With  a  full  understanding  of  the 
hardware,  experimental  results  are  presented  to  verify  the  theory.  The  results  of  the 
simulations  and  experiments  will  be  summarized  to  accumulate  the  combined  impact  of 
these  new  developments. 
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II.  ANALYTICAL  DEVELOPMENT 


A.  INTRODUCTION 

Theoretical  development  has  been  divided  into  two  distinct  areas  based  on  subject 
matter:  1)  acquisitions  maneuvers  utilizing  control  moment  gyroscopes,  and  2)  target 
tracking  maneuvers  with  adaptive  feedforward  control.  Spacecraft  attitude  dynamics  is 
the  key  foreknowledge  presented  first.  This  first  section  will  reveal  that  a  spacecraft 
performs  rapid  slew  maneuvers  by  generating  a  change  in  angular  momentum,  H.  To 
minimize  maneuver  time,  maximum  momentum  generation  is  required.  Discussion 
continues  in  the  second  section  with  an  understanding  of  how  CMGs  generate  torque 
(equivalently  momentum  change,  H  )  and  includes  an  introduction  of  four  new  methods 
to  maximize  torque  generation  for  rapid  spacecraft  slew  maneuvers.  Afterwards, 
adaptive  control  for  fine  target  tracking  maneuvers  is  described  beginning  with  the  basic 
Newton-Euler  relationship  for  spacecraft  attitude  dynamics.  Proposed  improvements  to 
existing  techniques  are  suggested,  so  the  theoretical  development  is  firmly  based  in  these 
existing  techniques.  Efforts  are  made  to  quickly  summarize  the  theory  of  previous 
researchers  then  clearly  indicate  improved  techniques. 

B.  SPACECRAFT  ATTITUDE  DYNAMICS  AND  CONTROL 

Newton’s  Law  is  commonly  known:  the  sum  of  forces  acting  on  a  body  is 
proportional  to  its  resultant  acceleration,  and  the  constant  of  proportionality  is  the  body’s 
mass.  This  applies  to  all  three  axes  of  motion  for  3-dimensional  space,  so  the  law  can  also 
be  stated  as  “the  summed  force  vector  [3x1]  acting  on  a  body  is  proportional  to  it’s 
resultant  acceleration  vector  [3x1],  and  the  constant  of  proportionality  is  the  body’s  mass 
matrix  [3x3]”.  One  crucial  point  is  that  this  basic  law  of  physics  applies  only  in  an 
inertial  frame  that  is  not  in  motion  itself. 

A  similar  law  may  be  stated  for  rotational  motion  just  as  we  have  stated  Newton’s 
Law  for  translational  motion.  The  rotational  motion  law  is  often  referred  to  as  Newton- 
Euler,  and  it  may  be  paraphrased  as:  “the  summed  torque  vector  [3x1]  acting  on  a  body  is 
proportional  to  it’s  resultant  angular  acceleration  vector  [3x1],  and  the  constant  of 
proportionality  is  the  body’s  mass  inertia  matrix  [3x3].”  Newton-Euler  also  only  applies 
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in  a  non-moving,  inertial  frame.  Notice  how  Figure  3  depicts  our  situation.  The 
equations  needed  to  express  the  spacecraft’s  rotational  motion  are  valid  relative  to  the 
inertial  frame  (indicated  by  subscript  “B/i”  often  assumed)  and  may  be  expressed  in 
inertia  coordinates  (‘x’  used  to  indicate  generalized  inertial  coordinates).  The  motion 
measurement  relative  to  the  inertial  frame  is  taken  from  onboard  sensors  expressed  in  a 
body  fixed  frame  (‘q’  used  to  indicate  generalized  body  coordinates).  It  is  stressed  here 
that  q  does  not  refer  to  the  inertial  quaternion  here.  Generally,  “x”  will  refer  to  quantities 
expressed  in  inertial  coordinates  and  “q”  will  indicate  expression  in  generalized  body 
coordinates. 


Another  common  manner  to  express  these  quantities  is  using  both  superscript  and 
subscripts.  Ref[17]  pg.  340  is  one  such  nomenclature  where  a>Bhl‘  is  used  to  describe 

angular  velocity  of  the  spacecraft  body  with  respect  to  inertial  expressed  in  body 
coordinates.  The  subscript  in  this  reference  refers  to  “expressed  in”  and  the  superscript 


refers  to  “with  respect  to,”  so:  H  = 


B 


B/i 

+  co 


x  H  where  H  =  J  ■  to . 


Still  other  references  reverse  the  sub/superscript  usage  so  that  cobliB  is  used  to 

describe  the  same  angular  velocity  of  the  spacecraft  body  with  respect  to  inertial 
expressed  in  body  coordinates.  All  the  various  nomenclatures  are  emphasizing  that 
differentiation  of  position  must  account  for  movement  of  a  frame  relative  to  the  inertial 
frame,  since  Newton  and  Newton-Euler  apply  in  the  inertial  frame.  The  complicated  use 
of  both  superscripts  &  subscripts  is  not  adopted  here.  In  this  document  q  refers  to 
“expressed  in”  non-specific  body  coordinates  (with  co  as  one  example  specific  body 
coordinate  for  rate)  and  x  refers  to  “expressed  in”  inertial  coordinates.  Since 
differentiation  with  respect  to  a  frame  remains  important,  subscript  “B/i”  is  retained  for 
this  purpose.  This  permits  easy  translation  of  nomenclature  between  the  two  major  topics 
investigated  in  this  thesis:  acquisitions  maneuvers  and  tracking  with  adaptive  control.  The 
literature  on  large  momentum  spacecraft  slew  maneuvers  often  uses  ©,  while  adaptive 
control  literature  is  often  uses  q  to  express  the  same  quantity.  a>B/i  will  indicate  angular 
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velocity  of  the  body  with  respect  to  inertial  expressed  in  body  coordinates  (equivalently 
*!»//)■ 

Note  the  applied  torque  T  is  a  rate  of  change  of  angular  momentum  H  where 
angular  momentum  is  the  product  of  mass  inertia  and  angular  velocity: 


,2{*:}=[m]|A’l 


Figure  3  Spacecraft  Dynamics  and  coordinate  reference  frames. 


Motion  equations  may  be  expressed  in  body  coordinates  if  the  body  coordinate 
frame  motion  is  addressed  relative  to  the  inertial  frame  where  motion  of  body  frame 
relative  to  inertia  is  indicated  by  subscript  ‘B/i’. 

[ J ] {^B/i  =  [ J ]  Mtf/i  +  HbH  x  [ J ]  WbH  (!) 

With  this  understanding,  equations  of  motion  of  a  spacecraft  with  no  assumed  control 
actuators  are  often  written  in  body  coordinates  dropping  subscripts  in  terms  of  the  non¬ 
specific  or  specific  body  coordinates.  In  equation  (2),  note  the  [C]  matrix  is  formed  by 
replacing  the  cross  product  operation  with  matrix  multiplication  of  a  skew  symmetric 
matrix.  This  procedure  is  performed  later  when  defining  a  reference  trajectory 
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(sectionII.0.00  for  adaptive  control  and  is  a  key  substitutive  step  in  the  stability  proof 
(sectionII.0.00  of  the  proposed,  improved  adaptive  control  algorithm. 

I  PL,  =>  <B  =  H  =  [J] {•>}  +  {«>}■ -  W  W  =  [J] {q}  +  jqMJ] {1}  <2) 

[C] 


Control  laws  are  written  to  command  (u)  a  torque  (or  momentum  rate)  to 
accomplish  a  maneuver  (H  ),  and  the  command  is  sent  from  the  control  law  to 

actuators  to  achieve  the  corresponding  spacecraft  system  momentum  rate  H .  Thus, 
frequently,  x  (for  torque  in  non-specific  body  coordinates),  u  (for  command),  and  H  for 
momentum  change  are  frequently  expressing  an  identical  magnitude.  Getting  back  to  the 
equations  of  motion  expressed  in  body  coordinates  (equations  1,2),  performing  the 
multiplications  reveals  a  nonlinear  set  of  equations. 


Define  the  angular  velocity  vector  and  its  derivative: 


v  r  v 


CO, 


co 


y 


>  =  < 


CO, 


«X 

q 


y 


r  and 


q. 


co. 


co 


y 


co. 


}  =  < 


q 

q 

q 


X 

y 

z 


> 


(3) 


Define  the  [3x3]  inertia  matrix 


Jxx 
J yx 
J zx 


Jxy 

Jyy 

Jzy 


J  xz 
Jyz 
J  zz 


and  multiply  out  equation  2: 


Tx 

H y  co z  +  Hz<x>y  +  J xx^x  +  J  xy^y  +  J  xz  (^z 

Ty 

>  = 

^  x  (,)z  ~  H  z  x  +  Jyx^x  +  J  yyJ’y  +  Jyz^z 

Tz, 

B 

—HxO)y  +  H y  co x  +  J  zx(^x  +  J zytJy  +  J  zz  (,)z 

xx 

®x 

COy 

d)z 

COyCOz 

0 

§ 

_ 1 

Ty 

>  = 

0)xCC>z 

< 

0 

COy 

d>z 

COzCOx 

,TZ  , 

B 

1 

1 

Xs 

0 

COyCOx 

COy 

d>z 

J  xx 
Jxy 

J xz 

Jyy 

Jyz 
,J  zz , 


=[®]{0} 


(4) 


(5) 
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Notice  the  x  axis  acceleration  depends  upon  motion  in  other  axes.  The  equations  of 
motion  are  nonlinear  and  coupled  due  to  off-diagonal  inertia  terms  and  the  cross  product 
operation.  The  equations  may  also  be  expressed  in  regression  form  as  the  product  of  a 
measurable  matrix  and  a  vector  of  unknown  parameters  to  be  estimated  (eqn.  5).  In 
instances  where  inertia  off-diagonal  terms  are  negligible  (as  in  eqn.  6),  motion  axes 
remain  coupled  by  the  cross-product  operation. 


Tx 

—  HyCOZ  +  Hz0)y  +  J  XX^X 

zy 

>  = 

^ X(’^Z  ~  H ZCOxJ yyd)y 

Tz, 

B 

—HxcOy  +  H  y  <x> x  +  J zz  6) z 

Notice  the  equation  may  also  be  written  as  a  product  of  a  matrix  and  a  vector 
comprised  of  6  inertia  components  of  a  symmetric  inertia  matrix.  This  fact  will  be 
exploited  later  using  adaptive  control.  Rotational  transformation  matrices  may  be  used  to 
translate  coordinates,  so  that  the  inertial  mathematical  expressions  (Newton,  Newton- 
Euler,  etc.)  may  be  expressed  in  body  coordinates,  [fjj^is  nomenclature  used  to 

express  a  rotational  transformation  matrix  that  expresses  an  expression  written  in  body 
coordinates  into  inertial  coordinates.  Later  the  two  basic  adaptive  control  techniques 
present  in  the  literature  are  respectively  fonnulated  in  inertial  and  body  coordinates,  so 
the  rotational  transformation  matrix  will  play  a  major  role  in  the  procedures. 


Lacking  any  external  disturbance  torques,  equation  (2)  may  be  written  in  a 
manner  that  highlights  the  use  of  CMG  actuators  to  generate  a  torque  by  momentum 
exchange: 

=  (7) 


In  order  to  achieve  a  specified  momentum  change  from  an  array  of  CMGs 
( H cmg  ),  a  command  must  be  submitted  to  the  gimbal  motor.  Torque  is  related  to  rate  of 

change  of  angular  momentum  via  Newton-Euler,  resulting  in  the  mathematical 
relationship  between  gimbal  commands  and  torque  output  called  a  CMG  steering  law. 
CMG  steering  laws  for  “i=l,2,3...”  CMGs  contain  a  matrix  ([A])  of  combinations  of 
CMG  skew  angles,  p.  and  CMG  gimbal  angles,  9;.  Equation  (9)  shows  this  relationship 
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for  i=l,2,3  CMGs  normalized  by  one  CMG’s  worth  of  momentum  ( 1H ).  CMGs  are 
inclined  such  that  their  gimbal  planes  form  skew  angles,  p.  with  respect  to  the  xy  plane 

as  depicted  in  Figure  8.  The  [A]  matrix  (containing  gimbal  angles,  0;  and  skew  angles,  p. ) 

must  be  inverted  to  find  the  required  CMG  gimbal  rate  command  for  commanded  output 
torque  per  equation  (12).  Begin  by  writing  equations  for  each  momentum  vector  in  xyz 
coordinates  for  3  CMGs  normalized  by  1H. 


H  CMC  —  hyX  +  hy\  +  hzz 

hx  =cosd^  -cosGj  +cosPsin02 
where  Ay=cosP(sin02-sin0p-cos02 

hL=  cosP(sin0^+sin02+sin02) 

cosPcos©2  -sin©^ 
sin02  cosPcos©^ 
sinPcos02  sinPcos©^ 
[A] 


0Hr 


00 


sin©^ 

-cosPcos©^ 

sinPcos©^ 


(8) 

(9) 


(10) 


The  Newton-Euler  relation  relates  generated  torque  to  the  timed-rate  of  change  of  angular 
momentum  of  the  spacecraft  system.  A  CMG  absorbs  momentum,  HCMG  causing  an 
equal  and  opposite  change  in  momentum  on  the  spacecraft.  For  3  CMGs,  the  general 
relation  for  momentum  change  is: 


H«=^|N^jp-e=[Ai{e> 

(11) 

[A]-1Hcwg=[A]-1[A]{0}={0} 

(12) 

Notice  we  invert  the  [A]  matrix,  so  that  we  may  use  the  required  momentum 
change  commanded  by  a  control  law  to  calculate  the  corresponding  CMG  steering 
commands.  For  this  reason,  the  equation  is  referred  to  as  a  CMG  control  steering  law. 
Singular  inversion  of  [A]  results  in  singular  conditions  that  can  result  in  loss  of 
spacecraft  attitude  control. 
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Figure  4  CMG  steering  relationship  with  a  feedback  controller. 


For  some  combinations  of  gimbal  and  skew  angles,  the  [A]  matrix  columns  can 
become  linearly  dependent.  At  these  combinations  of  skew  and  gimbal  angles,  the 
determinant  of  the  [A]  matrix  becomes  zero  leading  to  singular  inversion. 


det[A]=sinP|sin02  sin(0^+0^)  +cos|3cos02  sin(02-0p+2cos0^cos02cosp  j  (13) 


C.  ACQUISITIONS  MANEUVERS 

1.  Introduction 

Rapid  spacecraft  reorientation  often  drives  design  engineers  to  consider  use  of 
Control  Moment  Gyroscopes  (CMGs).  CMGs  are  momentum  exchange  devices  that 
exhibit  extreme  torque  magnification  (i.e.  for  a  small  amount  of  torque  input  to  the  CMG 
gimbal  motors,  a  large  resultant  output  torque  is  achieved).  Typical  output  torques  are  on 
the  order  of  hundreds  to  thousands  of  times  the  torque  output  of  reaction  wheels,  another 
kind  of  momentum  exchange  attitude  control  actuator.  A  CMG  contains  a  constantly 
rotating  (high  speed)  wheel  that  generates  a  strong  momentum  vector.  The  momentum 
vector  is  gimbaled  by  small  gimbal  motors  resulting  in  a  momentum  change  (i.e.  torque 
per  eqn.  11).  Reaction  wheels  must  spin  up  to  the  required  speed  to  generate  the 
commanded  torque  (taking  some  spin  up  time).  For  CMGs  however,  the  high  torque 
application  is  instantaneous. 

For  maximum  speed,  minimum-time  spacecraft  acquisitions  maneuvers, 
maximum  spacecraft  angular  momentum  generation  is  required.  Since  the  total  system 
angular  momentum  in  conserved,  maximum  CMG  momentum  is  implied.  Control  laws 
are  used  to  command  CMG  gimbal  steering  to  generate  this  angular  momentum. 
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Unfortunately,  certain  combinations  of  gimbal  angles  and  skew  angles  result  in  singular 
states  where  the  system  of  CMGs  cannot  generate  the  commanded  torque  despite  the 
non-saturated  state  of  the  CMG  array. 

Arguably,  the  most  common  configuration  for  a  skewed  array  of  4  CMGs  is  the 
“pyramid”  array  where  the  4  CMGs  are  skewed  at  an  angle  of  (3=54.73°  resulting  in  an 
“optimal  spherical”  max  momentum  capability  [17].  The  desire  for  such  a  configuration 
is  often  stated  as  an  equivalent,  maximized  momentum  capability  in  all  directions  based 
on  the  {++++}  or  { — }  OH  &  4H  saturation  singularities  (Figure  5)  where  all  four  CMGs 
are  pointing  in  the  same  direction  when  a  singularity  occurs  (also  called  saturation  in  this 
case).  The  typical  design  approach  may  be  succinctly  stated:  1)  Optimize  spherical 
momentum,  then  2)  minimize  impact  of  singularities.  The  approach  adopted  in  this  paper 
will  reverse  the  traditional  approach  as  follows:  1)  Minimize  singularities,  and  then  2) 
maximize  spherical  momentum.  Surprisingly,  the  result  turns  out  quite  differently. 


Figure  5  3/4  CMG  Singularity  nomenclature. 

Individual  CMG  momentum  directions  (positive -right  convention)  for  a  3/4  CMG  skewed  array  in  a 
singular  configuration  of  gimbal  angles. 
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Figure  6  Singular  surfaces. 

Left:  External  (4H  &  OH)  singularity  surfaces  typically  used  to  define  the  “optimal  spherical”  skew  angle, 
Right:  Internal  (1H  &  2H)  singularities  generate  errors  &  potential  instability  as  momentum  trajectory 
strikes  one  of  these  surfaces.  [6] 


Z 


CMGs  skewed  at  angle,  P  .  Gimbal  rotations  obey  right  hand  rule. 
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Unique  contributions  in  this  portion  of  the  thesis  may  be  summarized: 

1.  Development  of  the  optimal  geometry  for  skewed  arrays  of  only  three 
single-gimbaled  control  moment  gyroscopes  resulting  in  maximum  singularity- 
free  momentum  space, 

2.  momentum  space  rotation  to  place  maximum  singularity-free  momentum 
in  desired  direction 

3.  further  singularity  reduction  using  a  new  decoupled  control  steering 
technique, 

4.  development  of  a  simple,  yet  effective  singularity  penetration  method  to 
deal  with  the  residual  singular  states  remaining  in  the  momentum  space 


2.  The  %  Skewed  CMG  Array 

The  3/4  CMG  array  modifies  the  commonly  studied  4  CMG  skewed  pyramid.  A 
minimum  of  3  CMGs  are  required  for  3 -axis  control,  and  the  fourth  is  used  for  singularity 
avoidance.  With  the  3/4  array,  only  3  CMGs  are  utilized  for  active  attitude  control  with 
the  fourth  CMG  held  in  reserve  for  robust  failure  properties.  Experimental  verification 
will  be  provided  in  later  sections  utilizing  a  spacecraft  testbed  with  a  3/4  CMG  array 
containing  a  balance  mass  in  the  place  of  the  fourth  CMG  (Figure  8). 
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This  is  the  configuration  utilized  in  this  study  with  balance  mass  in  place  of  one  CMG  station. 


Many  of  the  cited  references  approach  CMG  singularity  avoidance  by  modifying 
the  [A]  matrix  itself  to  make  it  invertible  without  singularities.  The  approach  taken  by 
the  author  is  to  first  optimize  the  array  geometry  itself  for  the  maximum  singularity-free 
momentum  space  specifically  for  a  3/4  skewed  array.  Since  gimbal  angles  can  vary 
independently,  the  primary  design  task  is  to  choose  the  skew  angle  that  provides  the 
greatest  singularity-free  momentum.  With  all  three  CMGs  skewed  at  the  “optimal 
singularity-free ”  skew  angle  the  3/4  CMG  array  can  operate  at  momentum  values  less 
than  the  singularity-free  threshold  without  any  kind  of  singularity  avoidance  scheme. 
Further,  utilization  of  mixed  skew  angles  can  rotate  the  CMG  array’s  capability  to 
maximize  momentum  in  any  preferred  direction,  again  singularity- free.  Yaw  is  the 
preferred  direction  in  this  study.  A  direct  comparison  with  the  traditional  “optimal 
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spherical”  skew  angle  will  demonstrate  the  dramatic  improvement  in  torque  capability  of 
the  CMG  array.  Analytical  derivation  via  linear  algebra  is  followed  by  a  heuristic, 
geometric  analysis  approach  and  later  validated  experimentally. 


3.  Optimum  Geometry  Maximum  Singularity-Free  Momentum 

Singular  combinations  of  gimbal  angles  and  skew  angles  can  be  determined 
analytically  by  examining  the  determinant  of  the  [A]  matrix.  When  the  detenninant  goes 
to  zero,  the  matrix  has  linearly  dependent  columns  resulting  in  singular  inversion.  There 
are  six  cases  (with  multiple  sub-cases)  that  result  in  a  singular  [A]  matrix  with  (3,=P  for 
i=l,2,3. 


Case  1:  sin[3=0 

Case  2:  sin(9j+02)=sin(9y0i)+2cos0jCOs92COsP=O 


Case  3:  shhk 


sin(0^+0^)  +cos(3cos02  sin^-Oi^cosOjCosO^cosP 


=  0 


Case  4:  sinO^  =  cos[3cos02  =  0 

Case  5:  sin(9^+02)=cosPcos02  =0 

Case  6:  sin02=sin(02-0p+2cos0^cos02COsP=O 


Nontrivial  cases  may  be  analyzed  as  follows.  In  general,  for  a  given  skew  angle,  each 
case  produces  gimbal  angle  combinations  that  result  in  det[A]=0.  These  gimbal 
combinations  may  be  used  to  calculate  the  resultant  momentum  at  the  singular  condition 
(labeled  “singular  momentum,”  Hs  in  the  code  provided  in  the  appendix).  Minimum 
singular  momentum  values  may  then  be  plotted  for  iterated  skew  angles  0°  <f]  <  90° . 
Having  established  the  minimum  value  of  momentum  at  singular  combinations  of  gimbal 
angles,  singularity  is  avoided  provided  the  momentum  is  less  that  in  these  values  depicted 
in  Figure  10.  Thus  the  result  is  the  maximum  singularity-free  momentum  space.  Figure 
10  reveals  that  maximum  singularity-free  momentum  space  is  greatest  (1H)  for  ninety 
degree  skew  angles. 
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Magnitude  Angular  Momentum,  |H 


Figure  9  Skew  angle  optimization  method. 

Note  each  case  (1-6)  listed  above  has  multiple  sub-cases  that  cause  that  singular  case  to  be  met.  Sub-cases 
were  plotted  and  some  of  them  are  presented  in  Figure  9  for  demonstration  of  the  method.  Each  curve  in 
Figure  9  does  not  represent  a  case  (1-6)  directly. 


CMG  Skew  Angle,  p 


Figure  10  CONTRIBUTION  #1 :  Skew  angle  optimization  results. 

Analytical  demonstration  that  maximum  singularity-free  normalized  momentum  is  obtained  with  a  skew 
angle  ofp=90° . 
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Figure  1 1  Optimal  singularity-free  3/4  CMG  configuration. 

3/4  CMG  skewed  array  momentum  cutting  planes  withp=90°  . 

Recall  the  nomenclature  that  one  CMGs  maximum  momentum  is  designated  1H. 
A  ubiquitous  CMG  installation  geometry  is  th q  four  CMG  skewed  pyramid  with  CMGs 
skewed  at  54.73°  to  the  local  horizontal.  As  we  see,  this  extensively  studied  skew  angle 
yields  0.1 5H  momentum  before  reaching  a  singular  state  for  three  CMGs.  To  avoid 
singularities  to  maintain  attitude  control,  spacecraft  control  torque  is  limited  to  less  than 
0.1 5H.  Thus  utilizing  the  skew  angle  optimized  for  spherical  maximum  momentum  with 
four  SGCMGs,  only  15%  of  one  CMG’s  torque  is  achievable  singularity  free  utilizing 
three  SGCMGs.  Using  the  new  skew  angle  of  P=90°,  1.0H  is  achievable  singularity-free 
in  any  direction.  That’s  a  567%  increase  in  singularity-free  momentum. 

a.  Heuristic  Analysis 

The  preceding  analytical  analysis  reveals  singularity  free  operations  <1H 
in  all  directions  by  implication.  While  useful,  the  analytical  analysis  certainly  does  not 
yield  much  intuition  to  guide  the  attitude  control  engineer  to  design  safe  momentum 
trajectories  through  the  momentum  space.  Are  there  directions  that  can  exceed  1H 
singularity-free? 

Recent  advances  in  computer  processors  speeds  make  a  heuristic  approach 
easily  accomplished.  Consider  rotating  a  vector  360°  creating  a  CMG  gimbal  “cutting” 
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plane  (discretized  at  some  interval).  Then  rotate  the  gimbal  plane  360°  creating  a  lattice 
of  discrete  points  forming  a  solid,  fdled  sphere.  This  discretized  lattice  provides  points  to 
analyze  CMG  array  momentum.  This  is  easily  done  in  embedded  loops  of  computer  code. 
Each  discrete  point  corresponds  to  a  set  of  three  coordinates  or  equivalently  three  gimbal 
angles.  At  each  discrete  point,  singularity/non- singularity  of  [A]  is  established.  At 
singular  points,  the  normalized  magnitude  of  angular  momentum  may  be  calculated.  A 
point  may  be  plotted  at  the  magnitude  of  the  momentum  in  the  singular  direction.  This 
results  in  a  three  dimensional  singularity  map  granting  easy  intuition  for  maneuvering  in 
the  momentum  space.  Singular  surfaces  result  from  several  kinds  of  singularities:  OH, 
1H,  2H,  and  3H  depicted  in  Figure  5.  Typically,  skew  angle  is  detennined  by  the  outer, 
saturation  singular  surface  alone  (OH  &  3H  in  this  case  of  a  3/4  CMG  array).  In  order  to 
find  the  maximum  singularity-free  skew  angle,  the  analysis  absolutely  must  also  account 
for  the  1H  and  2H  internal  singularities. 

It  may  be  noted  here  that  the  often  used  “optimal  spherical”  skew  angle 
((3=54.73°  )  that  results  in  equivalent  momentum  in  all  directions  is  derived  utilizing  the 
OH  { — }  &  4H  {++++}  singular  surface  (Figure  5)  of  a  4  CMG  skewed  array.  The  4H 
singular  surface  is  the  saturation  surface  that  results  from  all  4  CMGs  pointing  in  the 
same  direction,  and  it’s  corresponding  saturation  surface  for  the  3/4  array  is  the  OH  &  3H 
singular  surfaces.  In  the  case  of  a  3/4  CMG  array  the  singular  surfaces  are  depicted  in 
Figure  12  for  the  often  used  “optimal  spherical”  momentum  skew  angle  ( [3=54.73°  ). 
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Figure  12  Optimal  singularity-free  3/4  CMG  singular  surfaces. 

Singular  surfaces  for  3/4  CMG  skewed  array  at  “optimal  spherical  “  momentum  skew  angle  p=54. 73° .  Top: 
1H  &  2H  surfaces,  Bottom  left:  1H  &  2H  surface;  Bottom  right=lH  &  2H  surfaces  inside  OH  &  3H 
surfaces. 


Note  the  spherical  nature  of  the  external,  saturation  singular  surface 
{+++}  typified  by  the  ubiquitous  4  CMG  pyramid  array  skewed  at  P=54.73°is  nearly 
maintained  in  the  3/4  array.  The  internal  1H  and  2H  singularities  are  quite  a  problem, 
since  they  occupy  a  large  portion  of  the  momentum  space.  The  combined  singularity 
hypersurface  makes  it  difficult  to  see  a  clear  momentum  path  away  from  the  origin 
(0,0,0).  This  is  quite  important,  since  CMGs  must  spin  up  at  a  zero-momentum  gimbal 
angle  configuration  lest  they  impart  massive  torques  onto  the  spacecraft. 
{0^ ,©2 ^03)={O,O,O}  is  one  very  common  zero  momentum  spin-up  configuration.  The 

typical  design  methodology  might  use  the  shape  of  the  3H  outer  momentum  surface 
{+++}  to  define (3=54.73°  as  the  “optimal  spherical”  momentum  skew  angle.  The  attitude 
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control  engineer  would  be  left  with  the  daunting  task  of  maneuvering  in  this  crowded 
momentum  space  while  trying  to  avoid  any  point  on  the  singular  hypersurface.  Striking  a 
singular  point  results  in  (at  least  temporary)  loss  of  attitude  control.  Also  note  the 
maximum  momentum  capability  {+++}  is  less  than  3H.  Per  Figure  10,  the  maximum 
singularity-free  momentum  capability  using  (3=54.73°  is  0.154868.  If  the  skew  angle 
were  increased  to  ninety  degrees,  singularity-free  momentum  would  be  increased  to  1.0. 
That  analytical  analysis  can  be  reinforced  with  a  heuristic  analysis  in  the  context  of  the 
momentum  space  singular  hypersurface.  Consider  the  singular  hypersurfaces  for 
heuristic,  geometric  observations. 


Figure  13  Heuristic  skew  angle  optimization. 

Increasing  (:S  for  a  3/4  CMG  skewed  array.  (:S  was  varied  in  5°  increments  from  0°  to  90°  identifying  the 
trend  represented  here  by  three  primary  plots  with  3H  &  OH  singular  surface  lightened  to  enable 
visualization  of  1H  &  2H  singular  surfaces:  f  =70  “presented  here. 
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Previously,  it  has  been  established  that  a  skew  angle  of  ninety  degrees 
results  in  a  singularity-free  momentum  space  of  1H  for  the  3/4  CMG  array.  Repeating 
the  numerical,  heuristic  singularity  analysis  as  skew  angle  increases  is  very  revealing. 
Displayed  in  Figure  13-Figure  15  is  the  singular  momentum  space  for  a  skew  angle  of  70, 
then  80,  then  90  degrees.  Notice  how  the  1H  &  2H  singular  surfaces  move  away  from 
the  (0,0,0)  momentum  point  and  gradually  converge  into  each  other  as  skew  angle 
increases  to  ninety  degrees.  Fewer  singular  surfaces  is  obviously  beneficial,  but  the 
vacancy  of  the  center  of  the  momentum  space  is  marvelous.  More  increments  of  skew 
angle  are  provided  in  the  appendix,  but  these  three  primary  increments  (70°,  80°,  90°)  are 
sufficient  to  reveal  the  trend  visually. 


Figure  14  Heuristic  skew  angle  optimization. 

Increasing  (S  for  a  3/4  CMG  skewed  array.  (S  was  varied  in  5°  increments  from  0°  to  90°  identifying  the 
trend  represented  here  by  three  primary  plots  with  3H  &  OH  singular  surface  lightened  to  enable 
visualization  of  1H  &  2H  singular  surfaces:  [3=80 0  presented  here. 
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Figure  15  Heuristic  skew  angle  optimization. 

increasing  (:’>  for  a  3/4  CMG  skewed  array.  (S  was  varied  in  5°  increments  from  0°  to  90°  identifying  the 
trend  represented  here  by  three  primary  plots  with  3H  &  OH  singular  surface  lightened  to  enable 
visualization  of  1H  &  2H  singular  surfaces:  (1  =90  “presented  here. 


The  (1,  =P=90°  result  is  a  nearly-football  shaped  singularity-free 
momentum  space  with  divergent  ends  instead  of  convergent  football  ends,  minor  radius 
of  1H  and  a  major  radius  of  2H  longitudinally.  Experimental  verification  of  this 
configuration  is  shown  in  a  later  section.  Consider  that  a  spacecraft’s  application  may 
prefer  the  maximum  momentum  capability  about  the  yaw  ( z  )  axis.  The  nearly-football 
shaped  singularity-free  momentum  space  can  be  rotated  via  mixed  skew  angles. 
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4.  Maximized  Momentum  Reorientation  with  Mixed  Skew  Angles 

Typically,  skewed  CMG  arrays  utilize  identical  skew  angles  for  each  CMG 
( Pi=P  ).  By  using  mixed  skew  angles,  the  singularity-free  “football”  shaped  space  can  be 
reoriented  to  place  the  maximum  momentum  direction  in  the  yaw  direction.  Six  possible 
momentum  reorientations  are  possible  by  laying  down  momentum  planes  from  ninety 
degrees  to  zero  degrees  as  displayed  in  Figure  16  resulting  in  rotations  of  the  momentum 
space  depicted  respectively  in  the  following  order  per  Table  1. 


Pi 

P2 

P3 

0° 

90° 

90° 

90° 

0° 

90° 

90° 

90° 

0° 

0° 

0° 

90° 

0° 

90° 

0° 

90° 

0° 

0° 

Table  1  Mixed  skew  angle  combinations. 

Six  possible  combinations  of  mixed  skew  angles  laying  one  or  two  momentum  cutting  planes  from  0°  to 
90°.  Corresponding  singular  hypersurfaces  are  depicted  in  respective  order  in  Figure  16. 


Notice  that  three  options  for  mixed  skew  angles  result  in  the  original  momentum 
space  rotated  about  z  such  thatx  <H>  y ,  while  two  other  options  generate  spherical 
momentum  space  filled  with  significant  internal  singularities.  Notice  the  center  of  the 
momentum  space  is  clogged  with  singular  surfaces  such  that  those  two  figures  are 
blackened  in  the  center.  Our  difficulty  seeing  the  center  is  indicative  of  difficulties 
steering  a  momentum  vector  through  that  space  without  striking  a  singular  surface  for 
those  two  mixed  skew  angle  combinations. 
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Figure  16  Mixed  skew  angle  singular  surfaces. 

Singular  hypersurfaces  resulting  from  6  possible  combinations  of  mixed  skew  angles.  Singular  surfaces 
correspond  to  respective  mixed  skew  angles  per  Table  1. 


One  successful  reorientation  {P1,P2,P3}={90o,0°,90o}  is  accomplished  by  simply 
sliding  the  second  CMG  from  90°  to  0°  resulting  in  yaw  momentum  maximization  with 
the  familiar  internal  singularity  structure.  Figure  17  depicts  a  3/4  CMG  array  skewed  at 
mixed  skew  angles  P,=90°,  P2=0°,  P3=90°.  CMG  trajectories  typically  begin  from  zero 
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momentum  states  and  {hx,hy,hz}={0,0,0}  is  obviously  one  such  state.  Trajectories 
originating  at  {hx,hy,hz}={0,0,0}  have  1H  spherical  momentum  capability  and  2H 
momentum  capability  about  yaw  (z )  singularity-free.  Momentum  trajectories  that  are 
initiated  from  points  near  (0,0,2)  can  traverse  to  (0,0, -2)  resulting  in  -4H  being  stored  in 
the  CMG  array  producing  +4H  momentum  change  imparted  to  the  spacecraft  about  yaw 
singularity  free. 


Figure  17  CONTRIBUTION  #2:  Momentum  rotation  with  mixed  skew  angles. 

{Pj^^U^ORO0, 90°}  mixed  skew  angle  momentum  hypersurface  and  cutting  planes  depicted  for  a  3/4 
CMG  skewed  array. 


5.  Singularity  Avoidance  with  Generalized  SR  Inverse 

References  [17], [23]  use  a  modified  form  of  the  pseudoinverse  to  invert  the  [A] 
matrix.  The  pseudoinverse  is  typically  used  for  the  over-determined  problem  of  4  CMGs, 
but  remains  applicable  to  the  determined  problem  of  3  CMGs,  since  the  pseudoinverse  is 
equivalent  to  the  regular  inverse  for  the  determined  problem.  The  modified  pseudoinverse 
is  called  the  Generalized  Singularity-Robust  Pseudoinverse  (A#)  according  to: 


T  T  -1 
=  A  (AA  +  AI) 


(14) 


Where  A  is  a  positive  scale  factor  automatically  adjusted  based  on  the  det[A].  As  det[A] 
approaches  a  singularity  (det[A]  — »  0)  A  is  adjusted  to  artificially  add  components  to 
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I 

[A]  to  avoid  singular  inversion.  Where  m  =  y  det(  A  A  ) ,  using  small  constants  for  A0 
and  m0,  the  relation  is  as  follows. 

A=h0a-mlmo)2  m<m0  {]5) 

I  0  rn  >  mQ 

Alternatively,  a  small  constant  may  simply  be  used  for  X.  The  basic  point  of  the 
algorithm  is  to  alter  [A]  such  that  singularity  is  avoided.  SR  Inverse  is  amongst  the 
approaches  for  CMG  singularity  avoidance  that  modify  the  [A]  matrix  itself  to  make  it 
invertible  without  singularities  and  will  be  attempted  experimentally  in  this  thesis.  Note 
that  increased  tracking  error  is  guaranteed,  since  we  are  adding  arbitrary  commands  to 
avoid  loss  of  attitude  control  due  to  singularities.  Military  spacecraft  require  fine 
pointing,  an  alternative  approach  that  can  follow  the  desired  momentum  trajectory  despite 
singularities  is  appropriate.  Consider  readdressing  the  most  fundamental  mathematical 
step:  the  combination  of  the  three  coupled  equations  of  motion  into  a  system  of 
equations  represented  in  matrix  form. 


6.  Singularity  Reduction  via  Decoupled  Control  Steering 

In  this  section,  we  derive  a  strategy  dubbed  decoupled  control  where  we  take 
advantage  of  the  simplifications  that  arise  from  the  optimum  singularity  free  skew  angle, 
P=90°.  Substituting  the  [A]  matrix  with  [1=90°  into  equation  2  yields: 
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-sin  6^ 
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Note  that  y-momentum  change  equation  has  become  decoupled  from  the  x  &  z 
equations.  Pitch  momentum  is  determined  completely  by  gimbal  #2.  The  pitch  equation 
may  be  separated  from  the  matrix  system  of  equations.  The  benefit  is  the  elimination  of 
singular  gimbal  commands  for  CMGs  that  are  not  in  geometrically  singular  gimbal  angle 
positions.  Consider  what  happens  if  the  first  &  third  CMGs  enter  a  combination  of 
gimbal  angles  that  satisfy  cosies  in  +sim9|COs6f  =  0  .  This  would  not  result  in  singular 

commands  to  CMG  gimbal  #  2.  CMG  gimbal  #2  would  receive  the  following  command: 


VsinflA 


(18) 


The  CMG  would  operate  normally  per  it’s  decoupled  steering  logic. 


Figure  18  CONTRIBUTION  #3:  Decoupled  control  steering  commands. 


7.  Singularity  Reduction  Simulation 

Large  yaw  maneuvers  were  simulated  using  typical  coupled  control  and  compared 
to  the  proposed  decoupled  control  strategy.  Firstly  a  +50°  yaw  maneuver  is  followed 
immediately  by  -50°  yaw  maneuver  then  regulation  at  zero.  The  results  of  both  methods 
are  displayed  in  Figure  19.  Notice  the  coupled  implementation  of  the  Moore -Penrose 
pseudo  inverse  results  in  dramatic  pitch  commands  each  time  the  momentum  trajectory 
strikes  the  singular  surface. 

On  the  contrary,  notice  how  decoupled  control  smoothly  traverses  the  singular 
surface  with  no  pitch  errors.  Since  analysis  and  simulation  both  indicate  the  proposed 
decoupled  control  technique  should  work,  experimental  verification  was  performed  on 
free-floating  spacecraft  simulator  (Figure  68-Figure  71). 
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Figure  19  SIMULATION:  Decoupled  control  steering. 

Comparison  of  typical  coupled  control  (thick-dashed)  with  to  decoupled  control  (thin  line).  Notice  small 
roll  (x)  errors  each  time  the  trajectory  passes  through  the  “doughnut”  singularity  surface  and  huge  roll  error 
when  trajectory  strikes  the  “ring”  singular  surface. 

8.  Singularity  Penetration  Algorithm 

Next,  consider  that  singularity  reduction  as  presented  is  restricted  to  geometric 
configurations  (CMG  skew  angles)  that  permit  control  decoupling.  Instead  consider 
penetrating  the  singular  surface  without  loss  of  attitude  control.  Attitude  control  is  lost 
when  the  closed  loop  control  law  tries  to  invert  a  rank  deficient  [A]  matrix.  When  the 
determinant  reaches  a  critical  low  absolute  value,  the  closed  loop  law  may  augmented  to 
include  a  unit-delay  activated  at  this  critically  low  value.  As  the  momentum  trajectory 
approaches  the  singularity,  increasingly  high  gimbal  rates  are  required.  When  the  unit- 
delay  is  switched  on,  the  previous  valid  (non- singular)  value  is  held  until  the  singularity 
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has  been  penetrated.  Then,  the  nominal  closed-loop  control  (inversion  of  [A])  continues 
to  control  the  spacecraft.  In  essence,  we  are  “ignoring”  the  anomalous  transient  as  we 
pass  through  the  singularity,  instead  holding  the  last  valid  steering  command  value. 
Henceforth,  the  technique  is  referred  to  as  SPUD:  singularity  penetration  w/  unit  delay. 


Figure  20  CONTRIBUTION  #4:  Singularity  penetration  algorithm. 

9.  Singularity  Penetration  Simulations 

The  following  plots  depict  results  of  simulated  50°  yaw  maneuvers  with  and 
without  SPUD  permitting  a  longer  maneuver  time  to  reduce  momentum  to  near  1H 
complicating  singularity  transgression.  The  fully  coupled  control  is  implemented  here 
without  the  decoupled  control  scheme  used  earlier  to  reduce  singularities.  The 
simulations  indicate  that  SPUD  is  effective  even  without  reduced  singularities  via 
decoupled  control,  thus  SPUD  is  more  generically  effective  for  other  geometric 
configurations  (CMG  skew  angles). 
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Figure  21  SIMULATION:  Singularity  penetration  Euler  angles. 

Comparison  of  Euler  angles  for  50°  yaw  maneuver  with  &  without  singularity  penetration  with  unit  delay 
(SPUD); 
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Figure  22  SIMULATION:  Singularity  penetration  tracking  errors. 

Comparison  of  Euler  angle  tracking  errors  for  50°  yaw  maneuver  with  &  without  singularity  penetration 
with  unit  delay  (SPUD); 
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Figure  23  SIMULATION:  Singularity  penetration. 

Comparison  of  det[A]  and  normalized  momentum  magnitude  for  50°  yaw  maneuver  with  &  without 
singularity  penetration  with  unit  delay  (SPUD) 


Figure  24  SIMULATION:  Singularity  penetration. 

Comparison  of  gimbal  rates  for  50°  yaw  maneuver  with  &  without  singularity  penetration  with  unit  delay 
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Figure  25  SIMULATION:  Singularity  penetration. 

Comparison  of  gimbal  angles  for  50°  yaw  maneuver  with  &  without  singularity  penetration  with  unit  delay. 

In  the  simulations,  singularity  penetration  with  unit  delay  was  engaged  when 
det[A]=0.01.  This  was  selected  based  on  previous  experimental  experience.  Instead, 
consider  raising  the  determinant  value  and  adding  a  gimbal  rate  saturation  criteria.  For 
all  intensive  purposes,  you  are  singular  at  that  point.  This  helps  smoothly  transit 
singularities  making  the  entire  momentum  space  accessible  for  rapid  target  acquisitions 
slew  maneuvers.  Following  target  acquisitions,  fine  tracking  must  be  maintained  to 
perform  the  military  mission. 

D.  TARGET  TRACKING 
1.  Introduction 

Target  tracking  from  a  low  or  mid  altitude  earth  orbit  is  complicated.  The  earth  is 
moving  underneath  the  satellite.  Despite  this  rapid  motion,  the  operational  mission 
demands  the  spacecraft  maintain  three-axis  attitude  control  while  maneuvering  to  track 
the  target  point  on  the  earth  noting  the  target  may  be  moving  uncooperatively  trying  to 
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avoid  detection.  Theoretically,  if  a  spacecraft  inertia  [J]  is  known  exactly,  an  ideal 
feedforward  command  xCommand  for  an  inertial  rotation  (with  acceleration  {x}),  could  be 

formulated  per  Newton-Euler  (Tcommand  =  [ j] {x}  )  executing  a  perfect  target  tracking 

maneuver  with  no  target  tracking  errors.  Real  world  considerations  (e.g.  noise, 
disturbances,  un-modeled  effects)  typically  generate  tracking  errors,  so  this  classical 
feedforward  command  is  typically  augmented  with  a  feedback  command  to  eliminate  the 
tracking  errors  after  they  have  been  incurred. 

For  the  case  of  un-modeled  inertia  errors,  the  predominant  command  is  the 
classical  feedforward  with  feedback  augmentation  as  a  secondary  but  critically  important 
component.  Fuel  expenditure  for  spacecraft  orbital  maintenance  maneuvers  are  amongst 
the  reasons  inertia  is  not  exactly  known  on-orbit.  The  ground  controller  designs  attitude 
commands  for  an  assumed  or  estimated  inertia  J  .  If  the  actual  inertia  were  greater  than 
estimated  ||  J  ||>||  J  || ,  the  classical  feedforward  command  will  result  in  inadequate  torque 

to  complete  the  maneuver.  On  the  contrary  if  ||  J  ||<||  J  || the  spacecraft  maneuver  would 
exceed  the  desired  maneuver.  Both  instances  result  in  tracking  error  that  is  corrected  by 
the  feedback  control  components  after  the  errors  have  been  incurred  and  measured. 


Figure  26  Spacecraft  command  relationships. 


Figure  27  One  kind  of  direct  adaptive  spacecraft  command  relationship. 
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Please  note  in  Figure  26-Figure  27  are  generic  with  regard  to  spacecraft  actuators. 
While  CMGs  have  been  assumed  so  far,  the  developments  presented  here  do  not  include 
any  actuator  dynamics.  It  is  presumed  that  whatever  control  is  generated  by  a  controller 
the  actuator  will  accomplish  the  commanded  control. 

Slotine  (Ref  [43],  [44])  introduced  an  a  nonlinear  adaptive  controller  that  modifies 
both  feedforward  and  feedback  control  signals  with  inertia  estimation  and  also  by 
utilizing  a  reference  trajectory  which  adds/sub  tracts  commanded  velocity  to  account  for 
position  error.  This  method  of  adaptive  control  is  referred  to  as  indirect  adaptive  control. 
Control  is  indirectly  adapted  by  explicitly  estimating  unknown  parameters  that  are  used  to 
formulate  the  control.  Direct  adaptive  control  techniques  reparameterize  the  control 
eliminating  the  explicit  estimation  of  plant  parameters  and  directly  adapting  the  control 
signal  itself.  In  the  case  of  Slotine’s  controller,  the  estimated  plant  parameters  are  in  the 
control,  so  either  term  (direct/indirect)  may  arguably  be  used.  For  this  paper,  Slotine’s 
approach  will  be  referred  to  as  indirect  adaptive  control.  Slotine’s  indirect  adaptive 
control  technique  was  compared  favorably  to  feedback  control  alone  (not  combined 
feedforward/feedback  as  is  typically  done)  [44].  One  particular  weakness  was  that  one 
single  matrix  in  the  adaptive  controller  requires  several  pages  to  express  leading  to 
unwieldy  and  unacceptable  computations.  Subsequently,  Fossen  modified  Slotine’s 
approach  to  solve  the  issue  of  unwieldy  calculations.  By  determining  the  reference 
trajectory  in  the  body  coordinate  frame  versus  the  inertial  coordinate  frame  as  Slotine  did, 
Fossen  derived  a  substantial  simplification.  The  method  was  not  derived  for  spacecraft 
rotational  maneuvers,  nor  were  simulations  or  experimental  verification  performed. 


Figure  28  Slotine/Fossen  indirect  adaptive  spacecraft  command  relationships. 
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Substantial  contributions  in  this  chapter  of  the  thesis  may  be  summarized. 


1.  Derive  the  9-parameter,  Slotine/Fossen  approach  for  3-dimensional 
rotational  spacecraft  control  including  comparison  versus  feedforward  + 
feedback  control  in  simulation  with  experimental  verification  (all  three  absent  in 
the  literature). 

2.  Reduced-order  estimation  (6-parameter)  will  be  shown  to  be  equally 
effective  utilizing  the  [Slotine/Fossen]  approach. 

3.  Further  estimation  reduction  (3-parameter)  will  be  suggested  with  some 
simplifying  assumptions  (estimate  only  diagonal  terms  of  inertia  matrix). 

4.  A  new,  improved  indirect  adaptive  control  technique  will  be  introduced 
utilizing  adaptive  feedforward  control  with  a  reference  trajectory  as  in 
[Slotine/Fossen],  but  retaining  simple  PD  feedback  control. 

5.  Finally,  it  will  be  shown  that  estimation  can  be  eliminated  altogether 
without  significantly  sacrificing  the  gained  performance  increases. 

Since  the  proposed  indirect  adaptive  control  technique  is  inspired  and  compared  to  the 
techniques  in  the  recent  literature  (Slotine/Fossen),  these  techniques  are  evaluated  first. 
With  an  understanding  of  the  current  methods,  the  proposed  techniques  are  easily 
understood  as  simplified  approaches  which  can  further  improve  performance. 


2.  Slotine/Fossen  Approach 

Recall  equation  2  repeated  here  for  clarity  in  terms  of  non-specific  body 
coordinate  q  assumes  no  particular  control  actuator.  This  equation  of  motion  may  be 
written  by  various  methods  (Newton-Euler,  Lagrange,  Kane’s,  momentum,  etc.)  as 
follows: 

bM+[cM=M  a?) 

where  [J]  is  the  inertia  matrix,  [C]  is  the  matrix  relating  the  motion  rates  to  the  Coriolis 
&  centripetal  forces,  x  is  the  sum  of  external  torques  and  q  is  the  body  coordinates  (e.g. 
roll  (j),  pitch  9,  yaw  \j /).  The  subscript  “B”  indicates  the  expression  in  the  body  coordinate 
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frame  (duplicative  when  using  q,  but  sometimes  included  for  clarity).  The  body 
coordinates  may  be  transformed  into  inertial  coordinates  via  the  transfonnation  matrix 


[R]b2,  {x}=[R  ]B2j{q}  (20) 

Similarly,  we  may  define  a  reference  trajectory  in  the  body  coordinates : 

{■*r }  =  [R]g2i  I '  (21) 

Rewriting  the  transformation  and  differentiating: 

{^}  =  [R]'1{^}  (22) 

{qr}  =  [RF1  }  -[Rr^RjCR]"1  {x/}  (23) 

We  may  use  these  quantities  to  define  a  control  in  terms  of  estimates  and  the  reference 
trajectory  per  Slotine  using  a  combined  error  measure  s  =  q-qr . 

[Rf  ([  J*  ]  {^ }  +  [c*  ]  { V })  -  [R]r  K„  {s}  =  [R]“r  {t}  (24) 

V 

O*(x,x,xr,xr)0 


Slotine  uses  the  linear  regression  model  [®*]{0|  to  define  an  equivalent  system  based  on 
parameter  estimates: 

*  * 

®  (x,x,xr,xr)  0  =  O  ( x,x,xr,xr )  0  +  error.  (25) 

unknown  measured  estimated  o'© 

The  estimates  0  are  adapted  using  an  adaption  rule  that  makes  the  closed  loop 

system  stable  in  the  Lyapunov  sense.  The  regression  model  is  then  used  in  the  control, 

* 

which  is  where  the  complication  arises.  The  <f>  (x,x,xr,xr)  matrix  of  “knowns” 

occupies  several  pages  and  is  used  at  each  time  step  to  formulate  the  adapted  control 
signal  making  the  method  computationally  impractical.  [Fossen]  on  the  other  hand 
formulates  the  regression  model  in  the  body  coordinates  eliminated  the  complications 
seen  above  with  the  numerous  multiplications  with  the  coordinate  transformation  matrix 
[R].  Picking  up  from  [Slotine]  "s  method  above,  we  can  simply  express  the  regression 
model  including  the  transformation  matrix. 
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(26) 


[Rf[j*]{)fr}i+[Rf[c,']{ir}i=[[j]{qr}+[C]{qr}]  =  ®(x,fti,i)0 

Note  the 0(x,q,qr,qr)  “measured”  matrix  has  no  asterisk.  Fossen  similarly  suggests 
adaptive  dynamics  using  an  estimate  of  the  regression  vector. 

0(q,q,qr,qr)  9  =  Q  (q,q,qr,qr)  0  +  error  (27) 

measured  unknowns 

In  order  to  do  this,  we  must  define  the  reference  trajectory.  The  modifications  to 
the  overall  feedforward  control  strategy  may  be  embodied  in  these  two  venues:  1) 
estimate/adapt  estimates  of  inertia  in  the  regression  model  above,  and  2)  choose  a 
reference  trajectory  that  addresses  system  lead/lag  when  applying  the  assumed  control  to 
a  spacecraft  with  modeling  errors,  disturbances  and  noise. 

a.  Reference  Trajectory 

Define  the  reference  trajectory  such  that  the  control  helps  the  spacecraft 
“catch  up”  to  the  commanded  trajectory.  If  the  spacecraft  is  actually  more  massive  than 
modeled,  it  needs  a  little  extra  control  to  achieve  tracking  than  will  be  provided  by 
classical  feedforward  control.  If  the  spacecraft  is  actually  less  massive  than  modeled,  the 
control  must  be  reduced  so  as  not  to  overshoot  the  commanded  trajectory.  Consider 
defining  the  reference  trajectory  as  follows. 

qr=q]~X(q-q]) 

a  a  (28) 

qr  =  '4d-A(a-qd) 

Note  we  have  scaled  the  reference  acceleration  and  velocity  to  subtract  the 
velocity  and  position  error  respectively  scaled  by  a  positive  constant,  X.  Notice  the 
example  in  Figure  29.  The  reference  trajectory  sometimes  leads  the  desired  trajectory 
(when  the  spacecraft  is  lagging  behind  the  desired).  The  reference  trajectory  also 
sometimes  lags  the  desired  trajectory  (when  the  spacecraft  is  leading  the  desired 
trajectory).  Accordingly,  subsequent  sections  will  evaluate  the  effectiveness  of  the 
reference  trajectory  where  the  estimation  dynamics  are  zero.  First,  let’s  conclude  the 
derivation  by  multiplying  out  the  linear  regression  fonn  so  that  the  reader  can  have  the 
simple  [Fossen]  control  equation  for  spacecraft  rotational  maneuvers. 
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Figure  29  Reference  trajectory  example. 

Reference  Trajectory  (dotted)  compared  with  desired  trajectory  (solid).  Notice  reference  sometimes  leads 
and  sometimes  lags  desired  trajectory  (based  on  tracking  error). 


Simplify  [ J]  { qr }  +  [C ] {<yr }  =  { r}  ^  with  reference  trajectory  qr  =  d>r  &  qr  =cor: 


[j]{thr  }  +  [C]{tur }  -  {rj  % 

(29) 

[J]{flV-}  =  [Hx]{flv}  +  W5 

(30) 

[3]{d)r}  =  [3}{(o}x{o)r}  +  {z}B 

(31) 

where  [h  x]  is  the  skew  symmetric  matrix  form  of  the  total  system  momentum  vector. 
Expand  [j]{<hr } -[Hx]|rur }  =  : 


J XX 

Jxy 

J xz 

®x 

Jyx 

J yy 

Jyz 

< 

6)y 

4s 
_ 1 

Jzy 

N 

i _ 

(Oz 

Multiplying  out: 


1 

o 

~HZ 

H y 

mx 

Hz 

0 

~HX 

< 

°)y 

1 

1 

4s 

Hx 

1 

o 

_ J 

(32) 
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—Hy(oz  +Hzo)y  +  J  xx^x,  +  J  xy^y,  +  ^  xz  (’-)z! 

I Ix(^zr  ~^za>xr  +  Jyx^x,  ^vv^v,  ^ yz ('->zr 
—Hx(Oy  +  H  yd>xr  +  J  zx('^xr  +  J  zv^y,  +  ^ zz  ('->zr 

Let#  =  \  j xx  ^ xy  ^ xz  Jyy  Jyz  #zz  ^ x  ^ y  ^ z j  assuming 
Jyx  ~  J xy ■>  J zy  =  ^  yz ’  # zy  =  #xz  implied  {uff\ideal  =  \®(a>r,<*>r^\$x 9  (®l9xl ' 


(34) 


Figure  30  CONTRIBUTION  5:  Derived  9-parameter  [Fossen]  modification  of  [Slotine]. 

[O(ryr,ryr)]{0}  =  0,0  +  error  (35) 

This  is  the  derivation  of  Fossen’s  modification  of  Slotine’s  indirect 
adaptive  feedforward  control  not  currently  in  the  literature  (Referred  to  as 
Slotine/Fossen).  Using  this  regression  model,  we  are  free  to  evaluate  the  first  substantial 
contribution  in  this  portion  of  this  dissertation.  After  comparing  this  approach  to  classical 
feedforward  and  feedback  control,  this  model  will  be  the  basis  upon  which  proposed 
improvements  are  made. 

The  dynamics  establish  the  classical  feedforward  command  when  the 
inertia  is  known  and  correct.  Accordingly,  utilize  the  estimated  dynamics  for  formulate 
the  adapted  feedforward  command  based  on  estimated  inertia.  Additionally,  feedback 
control  may  be  added  utilizing  the  reference  trajectory  in  a  PD  control  architecture. 
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(36) 


r  =  [(t>r]{0|-Rr  Kd(x-xd)  +  Kp{x-xd) 


d 


"P 


V 


u 


ff 


u 


fb 


Notice  this  definition  of  feedback  control  defines  the  reference  trajectory 
gain  X=  Kp  /K<i.  Thus  choice  of  Kp  and  Kd  constrains/defines  the  reference  trajectory. 
This  fact  will  be  utilized  later  to  improve  the  method. 


=  Kd(g-qd)-AKd(q-qd) 


K, 


(37) 


Similar  to  the  example  in  [44],  feedforward  techniques  in  this  study  are 


compared  by  fixing  feedback  gains:  Kp 


control  units 

=  200 - 

error  units 


2=1/2  Kp 


control  units 
=  100 - 

error  units 


This  causes  a  limitation  in  adaptation  of  the  feedforward  torque,  since  the  regression 
model  is  formulated  using  the  reference  trajectory.  The  proposed  technique  is  to 
feedback  the  desired  trajectory  rather  than  the  reference  trajectory.  This  allows  the 
reference  trajectory  to  be  more  aggressively  used  to  adapt  the  feedforward  control 
without  effecting  the  feedback  signal.  Another  way  to  look  at  it  is  fixing  the  X  for 
feedback  (referred  to  as  /.(b)  and  allowing  a  more  aggressive  feedforward  using  Ur- 


3.  Derived  Reduced  Estimation:  6-Parameter  Regression  (“Derived6”) 

Recalling  {H}=[J]{<n},  substitution  into  the  9-parameter  regression  model  allows 
reformulation  into  the  following  equivalent  6-parameter  regression  model. 


(38) 


Figure  31  CONTRIBUTION  6:  Reduction  of  Fossen’s  approach  to  6-parameters. 
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It  is  proposed  to  no  longer  estimate  the  rate  in  the  system  momentum  (since  we 
have  rate  sensors),  and  instead  estimate  only  the  unknown  inertia  tenns.  This  first 
proposed  adaptive  technique  ( Proposed6)  utilizes  this  reduced  regression  model  resulting 
in  analytically  identical  results  with  fewer  computations.  In  addition,  this  technique  will 
be  implemented  with  fixed  An,  and  variable  An-  in  a  new  proposed  indirect  adaptive 
control  to  be  described  in  section  0. 


4.  Proposed  Reduction:  3-Parameter  Regression  (“Proposed3”) 

Typical  assumptions  for  simplified  spacecraft  dynamics  modeling  include 
neglecting  inertia  cross-products.  The  result  is  the  following  regression  model. 
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Figure  32  CONTRIBUTION  7:  Reduction  of  Fossen’s  approach  to  3-parameters. 
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The  second  proposed  improvement  to  Slotine/Fossen’s  adaptive  technique 
(. ProposedS )  utilizes  this  regression  model. 


5.  Proposed  Adaptive  Control  Algorithm 

While  the  developments  so  far  simplify  the  promising  Slotine/Fossen  approach,  it 
is  noted  that  X  defines  the  reference  trajectory  which  is  fed  to  both  feedback  and 
feedforward  controls.  Recall  that  ideal  feedforward  control  perfectly  achieves 
commanded  maneuvers  if  the  modeled  inertia  is  exactly  equal  to  the  actual  inertia. 
Feedback  control  is  useful  to  catch  the  errors  after  they  have  already  been  incurred.  The 
Slotine/Fossen  approach  does  not  feedback  the  desired,  commanded  trajectory.  The 
feedback  signal  is  calculated  based  on  error  tracking  the  more  aggressive 
(leading/lagging)  reference  trajectory.  It  is  intuitive  to  make  a  more  aggressive 
feedforward  signal  if  your  inertia  estimate  is  low,  and  a  less  aggressive  feedforward 
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signal  if  your  inertia  estimate  is  high.  But  feedback  controls  are  attempting  to  fix  the 
attitude  at  the  next  time  step  with  error  based  on  the  previous  time  step  without  using 
knowledge  of  upcoming  trajectory  which  could  be  in  an  arbitrary  direction.  It  is  proposed 
that  using  the  correct,  desired  trajectory  to  define  the  error  in  the  feedback  control  while 
maintaining  the  reference  trajectory  for  adaptive  feedforward  should  result  in  lower 
tracking  error. 


Figure  33  CONTRIBUTION  8:  Proposed  adaptive  spacecraft  command  relationships. 


This  is  accomplished  by  introducing  a  A.ff  to  be  used  in  the  feedforward  signal 
identically  as  A,  previously  derived  in  the  Slotine/Fossen  method.  For  feedback,  will 
be  fixed  to  equate  to  nonnal  PD  (desired  trajectory)  feedback  control  per: 

<4 --?</>•  <4°) 


For  example,  the  feedback  control  signal  using  Slotine/Fossen  with  A,=l/2  would  equate 
to  the  proposed  method  feeding  back  the  desired  trajectory  with  a  normal  PD  control 
using  Kp=l  00,  IQ=200  (units  dropped  for  convenience).  The  feedback  control 
relationships  would  be  identical  using  either  method.  With  this  in  mind  it  will  become 
clear  that  increasing  ^ff  will  result  in  relative  improvement. 


T  = 


wM 

IT 


Kd(‘t-gd)-^Kd(g-gd'> 


(41) 
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a.  Stability  Analysis 

Consider  not  using  the  reference  trajectory  in  the  feedback  signal.  The 
previous  stability  proof  (Refs. [43], [46])  are  no  longer  valid.  The  control  equation  would 

be  z-  =  ®r0-Krfq-Kpq  (where  r  denotes  “reference,”  denotes  error  from  desired  and 

0  denotes  estimates)  and  the  estimation  equation  is  maintained  07  =  -s7  ®  ,r  where  T  is 

a  positive  constant  estimation  rate  gain.  And  “s”  is  a  measure  of  error  to  be  defined. 
Notice  that  this  estimation  dynamics  equation  implies  any  error  (including  noise  and 
disturbances)  will  result  in  estimate  dynamics  (not  just  parameter  error). 

r  =  ®r0-K^-Kpq 

©r  =  — sr®rr 

Figure  34  CONTRIBUTION  8  Proposed  Adaptive  Control  algorithm  (42). 


After  defining  requisite  quantities,  Lyapunov  analysis  demonstrates 
stability  and  convergence.  First  define  the  ideal  feedforward  control  from  the  dynamics. 
If  the  dynamics  were  exactly  known,  they  would  determine  the  feedforward  control  that 
would  accomplish  a  desired  maneuver  {qrf}  with  no  error. 

[j]{q}  +  [C]{q}  =  {t}  for  J  =JT>0,  j=0,  C=skew  symmetric 


Define:  [j]{q} +  [C]{q}  =  =  [j]{q,} +  [C]{q</}  =  {®}[0]  =  {u#} 


ideal 


Define  the  tracking  errors:  q  =  q  -  q^  Thus  q  =  q  (\  j  and  q  =  q  -  q 


ld 


Allowing  definition  of  the  reference  trajectory  qr  =  qrf  -  2(q  -  qrf)  =  -  2(q) 

q 


and  q,  =qd  -A(q-qJ  =  q(,  -A(q) 

q 


(43) 

(44) 

(45) 

(46) 


Define  a  combined  measure  of  tracking  error  (error  tracking  the  reference  trajectory): 


s  =  q-q,  =q  +  ^q  =  (q-qf/)+^(q-q£/) 


(47) 


52 


s  =  q-qr  =q+^q  =  (q-q^)+^(q-q</)  (48) 

From  our  earlier  regression  definition  of  the  feedforward  control, 

Define:  ®  =  {  /„  J„  J„  J„  J„  }r&®  =  0  (49) 

0=  /  J  J  J  J  J  \  (50) 

\  xx  xy  xz  yy  yz  zz  \  \  / 

Thus,  the  estimated  dynamics  may  be  defined  using  a  similar  regression: 

j]  {<L }  +  [c]  {qr }  =  [Or  (q,  q,  q, ,  qr )]  {©}  (51) 

Define  the  estimation  error  as  the  difference  between  estimated  and  actual  inertia: 

0  =  0-0  (52) 

Consider  the  candidate  Lyapunov  function: 

F=tsrJs  +  ierr”l@  +  iqr(aKJ+KJ>)q  (53) 

Differentiating: 

L  =  srJs  +  0T^10  +  qr(/lKrf+K/))q  (54) 


Substitute  for  s,  distribute  [J],  substitute  for  Jq  and  add  &  subtract  Cq,.  grouping  0,0  . 
Then  reverse  distribute  [C]  and  substitute  for  s  forq  -qr .  Use  skew  symmetry  to  reduce: 


V  =  sr  ( r  -  Jq,.  -  Cq, )  +  0rr  '©  +  f  (XKd  +  Kp  )  q  (55) 

From  Figure  34  r  =  O,.0-Krfq-K;,q  (56) 

Group  0,  0  and  equate  0  =  0  using  0  =  0. 

V  =  sr(o,.0-  KA  ~  Kpq)  +  6T  '0  +  f  (XKd  +  Kp  )  q  (57) 

Using  the  combined  measure  of  tracking  error  define  0r  =  -srO,.r  f>0  (58) 
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Cancel  ®(.0  and  substitute  for  s1  and  distribute  (q  +  Aq)T  twice.  Group  terms  then  reverse 
distribute  to  (A Kd  +  K p  j  canceling  (/'-Kd  +  K  j  terms. 

F  =  -4rK,4-^q%q^0|  (59) 

For  negative  semi-definite  Lyapunov  function  derivative,  Barbalat’s  lemma  says:  if  the 
differential  function  V(t)  has  a  finite  limit  as  t— (bounded)  and  is  such  that  V (t)  exists 
and  is  bounded,  then  V(t)—>0  as  t— >oo.  V(t)  is  lower  bounded  and  L(t)is  negative  semi- 
definite,  so  if  V(t)  is  uniformly  continuous  in  time,  then  V(t)—>0  as  t— >oo. 

V  =  -2 qrKdq-AqrKpq  and  q  =  q-q,.  Since  V(t)<V(0)Vt,  V(t)  =  V( s,q,q,0)  is 
bounded,  thus  s,  q,  q,  and  0  are  all  bounded.  Since  q  =  q  -  qrf  and  q  =  q  -  q^  are  bounded, 
and  q  ,  &  qrf  are  bounded  inputs,  q  and  q  are  bounded,  thus,  q  is  bounded.  Also,  since 
qrf  is  a  bounded  input,  q(,  is  bounded.  Additionally,  Since  0  =  0  -  0  is  bounded,  and 

0  is  a  bounded  real  world  system  (no  such  system  of  infinite  inertia),  0  is  bounded,  thus 
T(0,qr,qr)is  bounded.  Recalling  the  Newton-Euler  relation  and  our  defined  torque 

(noting  we  have  just  demonstrated  T(0,q;  ,q; )  and  qare  bounded),  q  must  be  bounded. 
[J]{q}  +  [c]{q}  =  T(0,q(.,q,.)^{q}  =  [J]_1[T(0,qr,q(.)-[c]{q}]  (60) 

Since  V  is  bounded,  V  is  uniformly  continuous.  According  to  Barbalat’s  lemma 

V  =  -qrKrfq-/LqrKpq^  0  as  t  ~^>cc .  q,q^0a5t^oo  (61) 

Estimate  convergence  requires  persistent  excitation  in  maneuvering.  Also 
note  that  this  stability  proof  requires  estimation.  Another  technique  without  estimation 
will  be  addressed  later,  and  stability  of  this  new  approach  cannot  be  demonstrated  with 
this  argument.  Adaptive  controllers  have  become  notorious  since  the  1960’s  and  1970s 
for  instability  often  due  to  estimation  parameter  drift.  In  1966  Michael  James  Adams 
was  killed  when  his  X-15  aircraft  was  torn  apart  due  to  his  adaptive  control 
system[47],[48].  The  X-15  entered  a  divergent  spiral  as  the  adaptive  controller  estimates 
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diverged[49],  Accordingly,  great  efforts  are  exerted  in  this  research  to  simplify  the 
estimation  and  eventually  eliminate  estimation  altogether. 


Figure  35  CONTRIBUTION  9:  Proposed  adaptive  feedforward  with  no  estimation. 


r  =  0( 0  - Kt/q - K/;q  where  0  =  0 

Figure  36  CONTRIBUTION  9  Proposed  Adaptive  Control  algorithm  (62). 


6.  Adaptive  Control  Simulations 

In  this  section,  a  nominal  target  tracking  maneuver  is  performed  with  various 
control  techniques  to  compare  performance.  The  maneuver  consists  of  a  steady  yaw 
(earth-tracking  maneuver)  with  sinusoidal  roll  (target  evasion).  Older  estimated  values  of 
the  experimental  testbed’s  inertia  (prior  to  installation  of  the  optical  payload)  are  used  as 
the  simulated  actual.  It  is  assumed  that  a  guess  of  inertia  is  available  to  design  the 
feedforward  torque  command.  The  feedforward  command  assumed  a  diagonal  inertia 
matrix  whose  components  were  10%  less  than  actual  values  for  simulations. 

actual  {old  data) 

The  controllers  were  individually  coded  in  MATLAB/SIMULINK  with  switches 
used  to  activate  controls.  Each  control  was  permitted  to  formulate  commands  for 
identical  desired  maneuvers  fed  into  an  identical  spacecraft  simulation  model  allowing 
“apples-to-apples”  comparison. 


119.1259  -15.7678  -6.5486 

-15.7678  150.6615  22.3164 

-6.5486  22.3164  106.0288 


(63) 
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Figure  37  SIMULINK  program  used  to  compare  advanced  control  algorithms. 


After  10  seconds  of  initial  regulation,  the  inertial  target  acquisitions  acceleration 
trajectory  is  as  follows. 
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Immediately  following  the  acquisition  maneuver,  the  inertial  target  tracking 
acceleration  maneuver  is  as  follows: 
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Recall  a  representative  military  space  mission  requiring  rapid  target  acquisitions, 
and  tracking  with  fine  pointing  may  be  tracking  a  non-cooperative  target.  The  maneuver 
trajectory  simulates  a  rapid  slew  yaw  maneuver  followed  by  aggressive  target  run  in  the 
yaw  axis  with  target  evasion  simulated  in  roll  axis. 


Control  Nomenclature 

Methodology 

[ Slotine/Fossen ] 

Adaptive  control  introduced  by  Slotine  and  modified  by  Fossen. 
Use  estimated  inertia  in  feedforward  signal  and  use  reference 
trajectory  to  adapt  both  feedforward  and  feedback  signals. 

Derived6 

Derived  6-parameter  estimation  fonn  of  [Slotine/Fossen]  shown 
to  be  identical  to  9-parameter  [Slotine/Fossen]  as  presented  in 
the  literature. 

Proposed6  ( 'F=i ) 

“i”  indicates  several  T s 
will  be  investigated. 

Suggested  adaptive  feedforward  using  6-parameter  inertia 
estimation  and  more  aggressive  reference  trajectory  with 
standard  PD  feedback  control.  T  is  the  estimation/adaption  gain, 
r  =0  indicates  no  estimation  (a  separate  technique). 

Proposed 3  ( T=i ) 

“i”  indicates  several  T s 
will  be  investigated. 

Suggested  adaptive  feedforward  using  3 -parameter  inertia 
estimation  and  more  aggressive  reference  trajectory  with 
standard  PD  feedback  control.  T  is  the  estimation/adaption  gain, 
r  =0  indicates  no  estimation  (a  separate  technique). 

Table  2  Nomenclature  of  adaptive  control  techniques. 
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Figure  38  SIMULATION:  Classical  Vs.  Slotine  comparison  10%  Inertia  Error. 

T=l,  Afb=l /2,  A,ff=l,Kp=100,Kd=200.  10%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by 
target  tracking  trajectory:  Feedback  control  comparison  Classical  feedforward  +  PD  feedback  versus 
[Slotine/Fossen]  as  proposed  in  the  literature.  Feedforward  control  assumed  10%  less  inertia  than  actual 
and  assumes  diagonal  inertia  matrix. 
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Figure  39  SIMULATION:  Classical  Vs.  Slotine  comparison  10%  Inertia  Error. 

r=l,  Afb=l/2,  %=l,Kp=100,Kd=200.  10%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by 
target  tracking  trajectory:  Feedforward  control  comparison  Classical  feedforward  +  PD  feedback  versus 
[Slotine/Fossen]  as  proposed  in  the  literature.  Feedforward  control  assumed  10%  less  inertia  than  actual 
and  assumes  diagonal  inertia  matrix. 


58 


Figure  40  SIMULATION:  Classical  Vs.  Slotine  comparison  10%  Inertia  Error. 

r=l,  A,fb=l/2,  A,ff=l,Kp=100,Kd=200.  10%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by 
target  tracking  trajectory:  Tracking  errors  (roll  <j),  pitch  9,  yaw  vp  in  degrees)  comparison  Classical 
feedforward  +  PD  feedback  control  versus  [Slotine/Fossen]  as  proposed  in  the  literature.  Feedforward 
control  assumed  10%  less  inertia  than  actual  and  assumes  diagonal  inertia  matrix. 
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Figure  41  SIMULATION:  Adaptive  control  comparison  10%  Inertia  Error. 

r=l,  Afb=l/2,  %=l,Kp=100,Kd=200.  10%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by 
target  tracking  trajectory:  Feedforward  control  comparison  [Slotine/Fossen]  as  proposed  in  the  literature 
versus  Proposed6.  Feedforward  control  assumed  10%  less  inertia  than  actual  and  assumes  diagonal  inertia 
matrix. 
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Figure  42  SIMULATION:  Adaptive  control  comparison  10%  Inertia  Error. 

r=i,  1/2,  Afj — 1  ,Kp=100,Kd=200.  10%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by 

target  tracking  trajectory:  Feedback  control  comparison  [Slotine/Fossen]  as  proposed  in  the  literature 
versus  Proposed6.  Feedforward  control  assumed  10%  less  inertia  than  actual  and  assumes  diagonal  inertia 
matrix. 
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Figure  43  SIMULATION:  Adaptive  control  comparison  10%  Inertia  Error. 


r=l,  /. n3=l/2,  A,ff=l,Kp=100,Kd=200  10%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by 
target  tracking  trajectory:  Tracking  errors  (roll  <j),  pitch  9,  yaw  v[/  in  degrees)  comparison  [Slotine/Fossen] 
as  proposed  in  the  literature  versus  Proposed6.  Feedforward  control  assumed  10%  less  inertia  than  actual 
and  assumes  diagonal  inertia  matrix. 
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Figure  44  SIMULATION:  Reference  Trajectory  comparison  10%  Inertia  Error. 

r=l,  Afb=l/2,  Xff=l,Kp=100,Kd=200 
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Figure  45  SIMULATION:  Proposed3  Vs.  Classical  feedforward  +  PD  feedback. 
r=l,  Afb=1/2,  A.ff=l,Kp=100,Kd=200  10%  inertia  error. 
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60  second  ATP  Simulation,  [J]error=10% 

RMS  (j)°  Error 

RMS  0°  Error 

RMS  \j /°  Error 

Kd=100;  Kd=200only 

1.16433297E-02 

1.13170883E-02 

4.69008123E-02 

Classical  uff  +  KD=Kd=200*  BASELINE 

4.18550804E-03 

1.031 11235E-02 

4.97428943E-03 

[Slotine/Fossen]  X-V2,  r=1,Kd=200 

3.547791 90E-03 

4.001 39441 E-04 

4.49608508E-04 

[Slotine/Fossen]  X= 1/2,  r=0,Kd=200 

3.54779201  E-03 

4.001 39485E-04 

4.49608482E-04 

Derived6:  X=M2,  r=1,Kd=200 

3.547791 90E-03 

4.00139441  E-04 

4.49608508E-04 

Proposed6\  %=1,  r=1,Kd=200,  %,=1/2 

3.43409393E-03 

4.31 624240E-04 

4.1 1224769E-04 

Proposed6\  %=1,  r=0,Kd=200,  A.fb=1/2 

3.43409412E-03 

4.31624299E-04 

4.1 1224783E-04 

Proposed3\  A.ff=1,  r=1,Kd=200,  i%=1/2 

4.22287958E-03 

6.00879340E-03 

4.83002003E-04 

Proposed3\  Xff=1,  r=0,Kd=200,  A*=1/2 

4.22287958E-03 

6.00879341  E-03 

4.83001 979E-04 

Table  3  Control  Simulation  Summary  (10%  Error). 

With  10%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by  target  tracking  trajectory: 
Tracking  errors  (roll  <)>,  pitch  9,  yaw  \|/  in  degrees)  comparison.  Feedforward  control  assumed  10%  less 
inertia  than  actual  and  assumes  diagonal  inertia  matrix.  Perfect  sensor  data  is  assumed,  so  experiments 
should  certainly  exhibit  higher  mean  square  errors. 


time(sec) 


Figure  46  SIMULATION:  Classical  control  comparison  30%  Inertia  Error. 

30%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by  target  tracking  trajectory:  Tracking 
errors  (roll  (j),  pitch  9,  yaw  vp  in  degrees)  comparison:  Classical  feedforward  +  PD  feedback  control  versus 
[Slotine/Fossen]  as  proposed  in  the  literature.  Feedforward  control  assumed  39%  less  inertia  than  actual 
and  assumes  diagonal  inertia  matrix. 
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Figure  47  SIMULATION:  Adaptive  control  comparison  30%  Inertia  Error. 

Large-angle  acquisition  maneuver  followed  by  target  tracking  trajectory:  Tracking  errors  (roll  (j),  pitch  9, 
yaw  \|/  in  degrees)  comparison:  [Slotine/Fossen]  as  presented  in  the  literature  versus  Proposed6  adaptive 
feedforward  &  PD  feedback  control.  Feedforward  control  assumed  30%  less  inertia  than  actual  and 
assumes  diagonal  inertia  matrix. 


60  second  ATP  Simulation,  [J] e rror=  30% 

RMS  <t>°  Error 

RMS  6°  Error 

RMS  ly0  Error 

KfIOO;  Ktp200on^ 

1 .1 64333E-02 

1.131 709E-02 

4.690081E-02 

Classical  Urr  +  Ko=Kcf200'  BASELINE 

5.81 9660E-03 

1. 04993  3E-02 

1  407292E-02 

[Slotine/F  ossen]  X=1  /2,  r=1  ,Kr200 

3.547792E-03 

4.001  394E-04 

4. 496085E-04 

[Slotine/F  ossen]  fc=1/2,  r^O.K^OO 

3.547792E-03 

4.001 395E-04 

4.496085E-04 

Deweo6:  X=1/2.r^1.KF200 

3.547792E-03 

4.001 394E-04 

4. 496085E-04 

Proposec/6:  A.,f=1 ,  r=1  ,1^200,  A*,=1/2 

3.434094E-03 

4  31 6242E-04 

4.11  2248E-04 

Proposed6.  X*f1 ,  r^O.Kr^OO,  J*,=1/2 

3.434094E-03 

4.31 6243E-04 

4.11 2248E-04 

Proposed3:  >.*=1 .  F=1  ,Kf200.  x*,=1/2 

4.222880E-03 

6. 008793E-03 

4. 830020E-04 

Proposed3.  A.tf=1  .  n=0.K<F200.  Au=1/2 

4.222880E-03 

6. 008793E-03 

4. 830020E-04 

Table  4  Control  simulation  summary(30%  Error). 

With  30%  Inertia  Error  for  large-angle  acquisition  maneuver  followed  by  target  tracking  trajectory: 
Tracking  errors  (roll  <)>,  pitch  9,  yaw  vp  in  degrees)  comparison.  Feedforward  control  assumed  10%  less 
inertia  than  actual  and  assumes  diagonal  inertia  matrix.  Perfect  sensor  data  is  assumed,  so  experiments 
should  certainly  exhibit  higher  mean  square  errors. 
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7.  Summary 

General  qualitative  conclusions  may  be  drawn  from  the  ideal  (no  noise) 
simulations.  PD  Feedback  alone  can  accomplish  the  maneuver,  but  combined  classical 
feedforward  plus  PD  feedback  control  is  much  better.  Slotine/Fossen’s  adaptive 
techniques  can  improve  performance  more  while  also  providing  updated  inertia  estimates 
(not  strictly  required  for  reduced  tracking  errors).  Furthermore,  a  simplified  6-parameter 
estimation  algorithm  retains  the  performance  of  Slotine/Fossen’s  method  with  further 
slight  improvements  where  the  feedforward  control  is  made  more  aggressive,  retaining 
PD  feedback  control.  The  proposed  adaptive  controller  uses  the  reference  trajectory  only 
for  feedforward  controls  allowing  this  performance  increase.  In  the  case  used  here 
(significant  off-diagonal  inertia  terms),  a  proposed  3-parameter  identification  also 
improves  perfonnance  compared  to  classical  feedforward  +  PD  feedback  control,  but 
does  not  perform  as  well  as  the  higher  computational  algorithms. 

Slotine’s  Hamiltonian  Adaptive  Control  of  Spacecraft  [43]  introduced  a 
promising  general  methodology  for  nonlinear  adaptive  control  of  spacecraft  with  inertia 
estimation.  The  technique  was  handicapped  by  its  derivation  in  the  inertial  reference 
frame.  Fossen’s  Comments  on  Hamiltonian  Adaptive  Control  of  Spacecraft  [46] 
suggested  equivalent  formulation  in  the  body  reference  frame,  considerably  reducing 
algorithmic  complexity.  Fossen’s  fonnulation  is  derived  and  demonstrated  here  to 
improve  performance  compared  to  feedback,  and  classical  feedforward  with  feedback 
controls.  Furthermore  an  improvement  is  presented  that  utilizes  the  desired  trajectory  in 
the  feedback  control  while  maintaining  the  reference  trajectory  in  the  feedforward 
control.  This  improves  performance  further  compared  to  all  control  methods.  Two 
alternative  formulations  are  presented  to  further  simplify  the  computational  complexity. 
A  mere-three  parameter  adaptive  control  is  even  capable  of  controlling  a  spacecraft  with 
non-negligible  products  of  inertia  based  on  these  results.  A  further  algorithmic 
simplification  is  available  by  eliminating  inertia  estimation  in  cases  where  the  estimates 
are  not  desired.  Noting  Table  3  &  Table  4,  r=0  was  used  to  eliminate  estimate  dynamics 
evaluating  the  effectiveness  of  reference  trajectory  without  estimation  (a  fixed  gain 
robust  controller).  While  the  tracking  performance  is  technically  degraded  (on  the  order 
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of  10'9  degrees),  essentially  no  performance  is  lost  by  only  using  the  reference  trajectory 

fixed  gain  robust  controller  eliminating  the  estimation  dynamics. 

1 .  Slotine/Fossen  improves  ATP  performance  compared  to  current  methods. 

2.  A  derived  “inertia-only”  estimation  method  ( Derived6)  is  identically  effective. 

3.  Proposed6  (maintaining  PD  feedback  control  and  increasing  6-parameter  adaptive 
feedforward  control)  further  improves  upon  Slotine/Fossen’s  results. 

4.  Proposed3  (maintaining  PD  feedback  control  and  increasing  3 -parameter  adaptive 
feedforward  control)  effectively  controls  (with  reduced  performance  compared  to 
other  adaptive  methods  only),  as  a  simplified  alternative. 

5.  Estimation  is  not  required  to  improve  tracking  performance 
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III.  EXPERIMENTAL  SPACECRAFT  SIMULATOR 


A.  INTRODUCTION 

A  major  contribution  provided  in  this  research  dissertation  is  comprehensive 
simulation  and  experimental  verification.  While  many  modem  algorithms  seem 
promising  on  paper,  real  world  situations  often  confound  some  modern  algorithms.  With 
this  motivation,  every  proposed  contribution  presented  here  has  been  experimentally 
verified  on  a  free-floating,  three-axis  spacecraft  simulator.  Such  large,  expensive  realistic 
hardware  is  rare,  so  it  is  natural  to  fully  explain  the  experimental  setup  in  detail.  The  free- 
floating  spacecraft  testbed  is  referred  to  as  TASS2  indicating  it’s  heritage  as  the  second 
such  testbed  developed  at  the  Naval  Postgraduate  School. 

The  first  testbed,  TASS1  (ref  [50])  was  much  smaller  and  did  not  utilize  control 
moment  gyroscopes.  The  spacecraft  testbed’s  payload  is  an  optical  relay  for  laser  beams. 
The  lower  deck  of  the  spacecraft  is  a  bench  model  spacecraft  with  control  moment 
gyroscopes,  active  mass  balancing  system,  fiber  optic  gyroscopes  for  attitude  rate 
sensing,  and  typical  onboard  computers.  The  upper  deck  of  the  testbed  is  an 
experimental  laser  optical  relay  designed  to  accept  a  laser  from  the  ground,  aircraft  or 
space-based  source  and  relay  the  laser  to  an  uncooperative  target  on  the  ground,  in  the  air 
or  in  space.  Description  of  the  mission  and  some  details  about  experimental  hardware 
may  be  found  in  ref  [53]. 

This  laser  relay  mission  demands  rapid  target  acquisitions  maneuvers  in  minimum 
time  followed  by  fine  pointing  during  target  tracking.  Accordingly,  it  provides  an  ideal 
venue  for  demonstration  of  the  ATP  improvements  recommended  in  this  thesis. 
Significant  research  effort  is  needed  to  develop  acquisition,  tracking,  and  pointing  (ATP) 
technologies  for  optical  spacecraft  applications.  Bifocal  Relay  Mirror  Spacecraft 
(BRMS),  whose  concept  is  shown  in  Figure  48,  is  a  good  example  of  the  importance  of 
developing  these  ATP  technologies.  The  BRMS  is  composed  of  two  optically  coupled 
telescopes  used  to  redirect  laser  light  from  ground-based,  aircraft-based  or  spacecraft 
based  lasers  to  distant  points  on  the  earth  or  in  Space. 
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Figure  48  Bifocal  relay  mirror  spacecraft  mission. 

The  transmit  telescope  is  attached  to  a  majority  of  the  spacecraft  bus  subsystems 
including  the  attitude  control  sensors  and  actuators.  The  spacecraft  mass  is  3300  kg  at 
launch  and  the  spacecraft  orbit  altitude  is  715  km  with  an  inclination  of  40  degrees.  The 
mission  requirements  are  for  a  3  meters  spot  beam  on  the  ground,  jitter  less  than  144 
nanoradians  (RMS)  and  mean  dwell  duration  per  pass  of  250  seconds.  The  acquisition 
sequence  consists  of  pitch  and  roll  motion  of  the  transmit  telescope  to  acquire  the  target 
point.  The  yaw  motion  of  the  transmit  telescope  and  the  one  axis  motion  of  the  receive 
telescope  is  used  to  acquire  the  receive  point. 

There  are  several  unique  multi-body  pointing  and  control  problems  in  the  BRMS. 
The  spacecraft  has  two  large  inertia  telescopes  that  are  gimbaled.  This  results  in  continual 
change  in  the  spacecraft  dynamics  and  spacecraft  inertia  during  the  operation.  The  BRMS 
also  must  slew  the  line  of  sight  at  a  fast  rate,  as  much  as  180  degrees  in  a  few  seconds 
permitting  laser  relay  to  another  relay  mirror  spacecraft.  Therefore,  high  control  actuation 
is  required.  Simultaneously,  the  vibrations  and  jitter  must  be  reduced  to  optical 
tolerances.  Therefore  BRMS  requires  high  bandwidth  stabilization  and  tracking  systems 
for  beam  control  as  well  as  the  fast  slew  maneuver  control  for  agile  spacecraft 
maneuvers.  The  choice  of  actuators  is  a  crucial  element  for  the  agile  maneuver  capability 
of  the  BRMS.  CMGs  are  preferred  actuators  with  high  torque  capabilities. 
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Ground  simulation  and  testing  of  these  techniques  are  highly  desirable  because  it 
is  extremely  difficult  to  test  and  reconfigure  the  system  once  the  vehicle  is  on  orbit. 
Rigorous  ground  testing  on  spacecraft  with  optical  payloads  will  significantly  reduce  the 
risk  of  the  project.  Spacecraft  simulators  are  supported  by  a  spherical  airbearing  to 
simulate  frictionless  rotation  of  a  free-floating  spacecraft.  The  airbearing-based  testbed 
requires  the  center  of  mass  location  of  the  spacecraft  is  accurately  aligned  with  the  center 
of  rotation  of  the  spacecraft.  Therefore,  there  is  an  added  complexity  of  eliminating 
unnecessary  gravity  disturbance  torque. 


Moving  Target- 
Source  Test  Fixture 


Extremely  Agile 
Relaying  Laser 
Source 


Optical  Payload 
with  Gimbaled 
Telescopes 


Spacecraft  Bus 
Simulator 


Spherical  Air 
Bearing 


Figure  49  Spacecraft  mission  simulators. 


Figure  49  illustrates  the  concept  of  the  experimental  testbed  for  the  BRMS.  The 
three-axis  spacecraft  bus  simulator  employs  the  optical  payload  including  optically 
coupled  receiving  and  transmitting  telescopes.  The  laser  beam  from  the  laser  source  on  a 
Moving  Target-Source  Test  Fixture  (MTSTF)  is  received  by  the  top  telescope  and 
transmitted  by  the  bottom  telescope  (fixed  to  the  bus)  to  the  target  on  the  MTSTF.  The 
top  and  bottom  telescopes  are  connected  by  the  rotational  stage  to  allow  the  gimbaled 
motion. 
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Figure  50  PFIOTO:  TASS2  Three-axis  spacecraft  simulator. 


Description  of  the  experimental  hardware  is  based  on  [51]  whose  graphics  were 
directly  replicated  here.  Figure  50  shows  the  actual  picture  of  the  three-axis  simulator 
named  as  TASS2.  The  spacecraft  bus  simulator  is  supported  on  a  spherical  air  bearing  to 
simulate  a  weightless  environment.  A  thin  film  of  compressed  air  is  injected  between  a 
spherical  ball  and  a  mating  spherical  cup.  This  thin  film  of  air  creates  an  essentially 
frictionless  lubrication  layer  between  the  ball  and  cup.  When  test  articles,  mounted  to  the 
ball  segment  are  balanced,  such  that  their  aggregate  center  of  gravity  corresponds  with 
the  center  of  rotation  of  the  ball,  rotational  motions  of  the  ball  and  test  articles  match 
those  of  an  object  with  similar  inertial  properties  free  falling  though  space.  Because  it  is 
important  to  minimize  the  disturbance  torque  from  any  imbalance,  three  servo  linear 
stages  with  lumped  masses  are  employed  for  automatic  mass  balancing.  The  three  linear 
stages  are  placed  parallel  to  the  three  spacecraft  body  axes. 

The  maximum  angular  motion  with  this  spherical  bearing  in  roll  and  pitch  is  45 
degrees.  However,  in  order  to  protect  the  hardware  from  damage  during  aggressive 
maneuvering,  a  bumper  with  a  structural  damper  is  installed  on  the  bottom  of  the 
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spacecraft  hub.  Therefore,  roll  and  pitch  motion  of  the  bus  is  limited  to  around  15 
degrees.  TASS2  has  three  variable  speed  control  moment  gyros  (CMGs),  Inertial 
Measurement  Unit  (IMU),  two  inclinometers  (roll,  pitch),  on-board  computer,  IR  sensor, 
and  magnetometers  for  navigation  and  attitude  control.  The  IMU  consists  of  3  Fiber 
Optic  Rate  Gyroscopes  with  integrated  3  translational  accelerometers.  The  signals 
generated  by  the  rate  gyros,  inclinometers,  and  IR  sensor  have  two  characteristics  that 
make  them  difficult  to  utilize.  First,  the  measurements  are  noisy,  and  this  noise  is 
significant  at  the  near-zero  rates  encountered  during  normal  operation.  Second,  the  gyro 
experiences  a  bias  that  slowly  varies  during  operation,  and  varies  widely  day-to-day. 

Variable  Speed  Control  Moment  Gyroscopes  (VSCMGs)  are  selected  as  main 
attitude  control  actuators  for  its  high  torque  capacities.  The  testbed  is  equipped  with  four 
VSCMGs  allowing  several  extra  degrees  of  freedom  to  accommodate  various  CMG 
singularity  avoidance  techniques.  In  this  study,  the  more  challenging  approach  is  taken 
utilizing  only  three  (non-redundant)  CMGs  operated  in  fixed-speed  mode.  Each  CMGs 
has  a  maximum  angular  momentum  of  22.5  N-m-s  and  a  maximum  torque  of  12  N-m  at 
2500  RPMs.  The  simulator  electronics  subsystem  is  an  integration  of  power  control 
switch  box,  power  switching  and  control  electronics,  and  industrial  PC.  The  power 
control  switch  box  has  a  main  power  switch  and  individual  switches  for  CMGs,  IMU, 
top-deck  control,  and  the  automatic  mass  balancing  system.  It  also  has  an  interface  with 
an  external  power  supply.  Power  switching  and  control  electronics  interface  CMG 
controllers,  IMU,  IR  sensor  (not  used),  and  inclinometers.  The  PC  104  industrial  PC  has 
an  analog  input  and  output  ports  as  well  as  digital  out  ports  to  send  the  commands  and 
receive  various  data  from  control  electronics.  The  main  control  program  is  coded  in  the 
host  computer  using  MATLAB/SIMULINK.  Real-time  control  software  is 
communicated  between  the  host  computer  and  target  PC  104  industrial  PC  via  wireless 
Ethernet  connection. 

The  optical  system  of  the  testbed  is  composed  of  the  Extremely  Agile  Relay  Laser 
Source  (EARLS),  TASS2  upper  deck  optical  payload  with  receiving  telescope,  TASS2 
lower  deck  optical  payload  with  transmitting  telescope,  and  diagnostic  target  board.  The 
EARLS  and  the  target  board  are  mounted  on  separate  linear  tracks  in  the  MTSTF  as 
shown  in  Figure  51. 
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Figure  51  PHOTO:  Moving  Target-Source  Test  Fixture  with  Laser  Source  and  Target. 


B.  THREE-AXIS  SATELLITE  SIMULATOR 

Notice  in  Figure  52  -  Figure  53  the  satellite  simulator  is  composed  of  a  spacecraft 
bus  (bottom)  with  an  optical  payload  mounted  on  the  upper  deck.  Initial  inertia  estimates 
used  in  the  adaptive  control  presented  earlier  were  values  experimentally  estimated  prior 
to  installation  of  the  upper  payload  deck.  The  upper  payload  deck  is  fixed  to  the  satellite, 
so  the  spacecraft  attitude  control  system  must  guarantee  the  payload  bore  sight  is 
maintained.  The  ground/air/space  based  source  laser  is  received  through  the  lower 
telescope  and  optically  relayed  to  the  upper  telescope  for  transmission  to  the  target.  The 
upper  telescope  is  mounted  on  a  small  platform  that  gimbals  with  respect  to  the 
spacecraft  and  lower  payload  deck.  This  fourth  degree  of  freedom  allows  the  spacecraft 
to  maintain  source  laser  pointing  in  three  dimensions  and  simultaneously  track  a  moving 
target. 

At  the  rear  of  each  telescope  note  fast  steering  mirrors  provide  extremely  fine 

(prad)  pointing  control  as  long  as  the  correct  bore  sight  is  maintained  by  the  spacecraft 
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(keep  the  laser  on  the  mirrors).  A  jitter  sensing  position  sensing  device  (PSD)  is  provided 
on  the  upper  deck  to  allow  fine  control  pointing  algorithms  to  remove  jitter.  Sensors  and 
multiple  electronics  boxes  are  mounted  on  the  underside  of  the  top  deck  (pictured  below). 
Sensors  include  inclinometers,  magnetometers,  sun  sensors,  and  star  sensors  for  angle 
with  ring  laser  gyroscope  (inertial  measurement  unit)  for  angular  rate.  Payload  cameras 
also  sense  source  laser  beacons  and  targets.  Actuators  include  control  moment 
gyroscopes,  balancing  mass  actuators,  fast  steering  mirrors  and  a  motorized  drive  to 
gimbal  the  optical  deck.  Numerous  electronic  busses  control  electrical  signals  and  power 
to  each  device  and  interaction  with  desktop  computers  running  MATLAB/SIMULINK  is 
provided  by  XPC  Target  through  a  wireless  router. 


Figure  52  PHOTO:  Three-axis  satellite  simulator  2  (TASS2). 
Photograph  on  TASS2  free-floating  experimental  testbed  at  the  Naval  Postgraduate  School 
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Figure  53  CAD:  Three-axis  satellite  simulator  2  (TASS2). 
Equipment  location  on  TASS2  free-floating  experimental  testbed  at  the  Naval  Postgraduate  School 


Hardware 

Nominal  performance  specification 

CMGs 

24.4  N-m-sec  at  2800  RPM 

Resolution:  182  counts/  degree 

IMU 

Max  bias=0.357hour; 

cr .  =0.28  rad/sec,  cr .  =0.26  rad/sec,  cr .  =0.26  rad/sec 
(f)  0  ¥ 

Table  5  TASS2  key  sensor/actuator  specifications  summary. 


1.  Sensors 

Experiments  presented  here  integrated  rate  data  from  the  ring  laser  gyroscopes 
(inertial  measurement  unir  or  IMU).  A  Northrup  Grumman  LN-200  fiber  optic  gyro 
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(FOG)  with  silicon  accelerometers  provides  inertia  angular  rate  measurements  with  a 
minimum  spin  up  time  of  0.8  sec  with  maximum  accuracy  achieved  after  5  seconds. 
Maximum  bias  variation  is  0.35°/hr  with  a  repeatability  of  1-10  °/hr  (la).  The  IMU 
interface  is  mounted  underneath  the  top  plate.  Power  to  the  IMU  interface  is  applied  by 
switching  the  IMU  switch  on  the  switchbox.  The  IMU  interfaces  converts  the 
synchronous  custom  protocol  IMU  data  (LN-200  data)  to  asynchronous  RS-422  data  for 
the  FCU  (via  the  power  switching  electronics). 


2.  Actuators 

Three  24.4  N-m-sec  (at  2800  rpm)  GDC  single-gimbaled,  variable-speed  control 
moment  gyroscopes  (Figure  54)  are  the  main  spacecraft  attitude  actuator.  Rotor  speed 
and  gimbal  controllers  were  made  by  ACEI.  By  fixing  the  rotor  speed  controller  and 
gimbal  controllers,  the  CMGs  can  act  like  reaction  wheel.  Variable  speed  was  not  used 
in  this  study  by  fixing  the  rotor  speed  but  allowing  the  gimbals  to  move.  Gimbal  angle 
feedback  is  provided  by  the  gimbal  motors  position  encoder. 


Figure  54  PHOTO:  Control  moment  gyroscopes: 


GDC  single-gimbaled,  variable-speed  control  moment  gyroscope 
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3.  Electronics  and  Electrical  Power 

The  TASS2  electronics  package  is  an  integration  of  four  electronic  box  types  and 
one  industrial  embedded  computer  on  the  spherical  air  bearing,  a  battery  charger  and  a 
desktop  XPC  host  computer  are  located  off  of  the  platfonn.  The  electronic  boxes  on  the 
platform  consist  of  a  sun  sensor/power  switching  electronics  assembly,  an  RF  model 
(wireless  Ethernet  hub),  4  CMG  controllers  and  a  switch  box.  The  power  system  consists 
of  the  switchbox,  charger,  and  two  gel  cells  12V  24Ah  lead  acid  batteries.  The  power 
system  is  rated  to  operate  at  100A  of  current.  The  bus  voltage  is  a  nominal  24.8V  and  is 
rated  to  operate  down  to  18.5V  at  which  the  switchbox  will  automatically  disconnect 
power  from  the  power  bus  to  protect  components.  With  all  the  components  in  the  system 
powered  up,  the  system  draws  3.6A  (no  torque  applied  to  the  CMG  rotors).  At  this 
current,  the  system  is  capable  of  running  for  over  six  hours  without  recharging. 
Additional  power  required  to  torque  the  rotors  would  shorten  this  time.  It  is  possible  to 
charge  the  batteries  while  running  the  system  from  external  power,  so  that  while 
preparing  to  run  an  experiment,  the  batteries  do  not  have  to  be  depleted.  This  may  be 
done  by  connecting  the  power  umbilical  to  the  front  switchbox  with  the  big  red  switch  in 
the  “in”  position.  The  batteries  may  not  however  be  charged  while  the  system  is  running 
off  of  the  batteries.  There  is  also  the  ability  to  power  the  CMG  rotors  from  battery  power 
while  running  all  the  other  components  from  external  power  by  simply  keeping  external 
power  applied  when  switching  to  internal  power. 

The  power  switch  box  is  the  main  user  interface  for  powering  the  individual 
components  of  the  TASS2.  It  also  controls  the  type  of  power  to  be  used  on  the  platform 
(“on  board”  battery  power  or  external  power  from  the  external  source).  It  is  also  used  as 
the  interface  for  the  charger  unit.  The  switchbox  has  digital  displays  for  the  system 
voltage  and  current.  It  also  provides  protection  against  low  voltage  operation  (which  may 
damage  some  system  components),  as  the  built-in  switchbox  will  remove  power  from  all 
components  if  the  system  voltage  drops  below  18.5V.  It  is  recommended  that  the  system 
is  powered  from  external  power  whenever  possible  to  insure  that  there  is  adequate  power 
when  a  simulation  is  to  be  run.  All  systems  can  be  powered  from  external  power  with  the 
exception  of  the  CMG  rotors  (although  gimbals  and  controllers  will  still  function  if  not 
attempting  to  spin  the  rotors  up/down).  CMG  controllers  are  mounted  to  the  outside  edge 
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of  the  CMG  mechanical  hardware.  The  CMG  controllers  are  the  interface  between  the 
control  unit  (via  the  power  switching  electronics)  and  the  gimbal  motor  on  the  CMGs  as 
well  as  the  analog  command  to  the  Emoteq  brushless  motor  drive  for  the  CMG  rotor.  The 
CMG  controllers  also  provide  an  analog  feedback  for  the  gimbal  position  and  rate. 
Analog  information  is  provided  by  a  conductive  plastic  potentiometer  (Bourns  P/N  - 
6639S- 1-502)  with  +5V  excitation.  Power  to  the  CMG  controllers  is  applied  by  switching 
the  CMG  switch  in  the  switch  box.  The  CMG  controller  uses  serial  command  inputs,  and 
also  has  analog  input  capability  to  control  the  CMG  it  is  wired  to.  The  Emoteq  brushless 
motors  are  designed  for  high  torque  to  inertia  and  size  ratios  and  contain  high  energy 
neodymium  iron  boron  magnets,  samarium  cobalt  magnets  for  operation  in  harsh 
environments,  and  Hall-effect  sensors  for  commutation.  Hall-effect  sensors  are  integral  to 
the  motor  and  require  no  setup  on  the  part  of  the  user. 

Three  leveling  mass  interfaces  (ACEi  PN#  NPS-05413)  in  are  mounted  on  the 
lower  equipment  deck  near  the  linear  actuator  they  control.  The  leveling  mass  interfaces 
are  the  interface  between  the  FCU  via  the  power  switching  electronics  and  the  linear 
actuator  motors.  Power  to  the  leveling  mass  interfaces  is  applied  by  switching  the 
BALANCE  switch  on  the  switch  box.  The  leveling  mass  interface  uses  serial  common 
inputs  to  control  the  linear  actuator  it  is  wired  to.  All  three  controllers  are  identically 
controlled,  but  the  vertical  actuator  also  automatically  controls  a  brake  to  prevent  the 
mass  from  sliding  (due  to  gravity)  when  the  controllers  are  off.  The  controllers  can  save 
the  last  “home”  position  to  non-volatile  memory,  so  that  when  a  controller  is  powered  up, 
it  can  find  the  last  saved  position  (this  can  be  reset  to  dead  center  of  the  actuator  also). 

Power  to  the  Ethernet  wireless  transceiver  is  applied  automatically  upon  system 
power  up.  Initialization  is  automatic  and  requires  no  user  interaction.  The  wireless 
Ethernet  transceiver  allows  wireless  communication  via  TCP/IP  protocol  of  xPC  data  to 
the  host  PC  located  off  the  platfonn.  It  is  a  standard  commercial  802.1  lb(Dlink)  wireless 
Ethernet  switch. 

The  industrial  embedded  computer  uses  a  data  acquisition  interface  via  MATLAB 
XPC  to  read  in  analog  sensor  measurements,  and  the  RS-232  communications  port  to 
communicate  with  the  power  switching  electronics.  The  computer  uses  2  analog  cards 
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(Diamond  MM32,  and  the  Diamond  Ruby  MM8)  to  input  sensor  data,  and  output  analog 
commands,  such  as  CMGs  when  in  analog  mode.  The  computer  is  based  on  the  Intel 
Pentium  III  750Hz  platform  running  xPC  for  on-board  -  remotely  updateable  control. 


4,  Mass  Balancing 


Figure  55  PHOTO:  Mass  balancer. 
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IV.  EXPERIMENTAL  RESULTS 


A.  ACQUISITIONS  MANEUVERS  EXPERIMENTS 

1.  Optimal  Singularity  Free  Momentum 

Experimental  verification  is  performed  to  demonstrate  singularity  free  operations. 
A  +5°  degree  yaw  maneuver  in  4  seconds  is  followed  by  a  -5°  yaw  maneuver  in  4 
seconds.  The  attitude  is  regulated  to  zero.  The  CMG  continues  to  output  significant 
torque  to  counter  dramatic  gravity  gradient  disturbances  typical  of  imbalanced  ground 
test  spacecraft  simulators.  This  maneuver  has  been  previously  performed  using  a  skew 
angle  of  57  degrees  (not  depicted).  The  CMG  array  became  singular  and  attitude  control 
was  lost  motivating  this  study.  Skew  angle  was  increased  to  ninety  degrees  for  all  three 
CMGs,  and  the  identical  experiment  was  repeated.  The  resultant  experimental  momentum 
trajectory  is  placed  in  the  context  of  the  theoretical  singular  momentum  space  for  easy 
visualization.  Notice  in  Figure  56  that  the  maneuver  is  performed  and  the  testbed  is 
regulated  for  5  minutes  without  striking  any  singular  surfaces.  Momentum  magnitude  and 
the  inverse  of  the  condition  of  the  [A]  matrix  verily  this  assertion.  Thus,  the  singularity- 
free  approach  has  been  demonstrated  not  to  spoil  tracking  accuracy  at  least  within  the 
current  attitude  and  rate  sensing  accuracy  of  the  testbed. 

Notice  what  happens  when  the  same  momentum  trajectory  is  placed  in  the  context 
of  the  theoretical  singular  momentum  space  of  the  “optimal  spherical”  skew 
angle,  [3=54. 73°  (Figure  58)  which  shares  a  very  similar  momentum  space  appearance  as 
the  previously  used  [1=57°.  The  internal  singular  surfaces  are  depicted  individually  for 
ease  of  visualization.  This  momentum  trajectory  is  constantly  close  to  the  internal 
singular  surfaces  and  strikes  an  impassable  singular  surface.  A  corresponding  impassable 
singular  surface  exists  for  a  skew  angle  of  57°.  Prior  experiments  using  57°  went  singular 
and  resulted  in  the  loss  of  attitude  control  when  the  momentum  trajectory  struck  this 
corresponding  impassable  singular  surface. 
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X  -2  ^ 

Figure  56  EXPERIMENT:  Optimal  configuration. 


+5°  yaw  in  4  seconds,  -5°  yaw  in  4  seconds,  then  regulate  at  {x,y,z}={0,0,0}  countering  cg-offset 
disturbance  torque  of  unbalanced  ground  test  satellite  simulator.  Momentum  trajectory  placed  in  context  of 
theoretical  singular  momentum  hypersurface  of  P1=90°  configuration. 


Figure  57  EXPERIMENT:  Optimal  Configuration. 

+5°  yaw  in  4  seconds,  -5°  yaw  in  4  seconds,  then  regulate  at  {x,y,z}={0,0,0}  magnitude  of  normalized 
momentum  and  inverse  of  condition  number  of  [A]  matrix  (would  approach  zero  if  array  became  singular). 


80 


Figure  58  EXPERIMENT:  Configuration  comparison. 

Experiment  from  Figure  56  performed  in  P,  =90°  configuration  placed  in  context  of  “optimal  spherical” 
Pj=554.730  for  the  purpose  of  comparison.  Note  continuous  flirting  with  singular  surfaces  and  impact  with 
impassable  surface  occurs  less  than  14  way  through  trajectory.  This  trajectory  would  not  have  continued  as 
depicted  had  the  skew  angles  been  P,=54.73° ,  instead  the  array  would  have  gone  singular  and  attitude 
control  would  have  been  lost. 


2.  Max  Momentum  Reorientation  with  Mixed  Skew  Angles 

Next,  experiments  were  performed  with  mixed  skew  angles  to  orient  the 
maximum  momentum  capability  about  the  yaw  axis  as  seen  in  Figure  59.  The  maneuvers 
were  increased  325%  in  the  same  duration  from  4°  to  IS 0  in  only  4  seconds.  This 
demands  significantly  more  momentum  change  specifically  about  yaw.  The  momentum 
is  achieved  singularity  free  and  maneuver  is  performed  without  incident. 
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Figure  59  EXPERIMENT:  Mixed  skew  angles. 

+13°  yaw  in  4  seconds,  -13°  yaw  in  4  seconds  performed  in  mixed  skew  angle 

configuration.  Momentum  trajectory  placed  in  context  of  theoretical  singular  hypersurface. 


Figure  60  EXPERIMENT:  Mixed  skew  angles. 

+13°  yaw  in  4  seconds,  -13°  yaw  in  4  seconds  performed  in  {PpP2,P^}={90o,0°,90o}  mixed  skew  angle 
configuration.  Maneuver  momentum  and  inverse  condition  of  [A]. 
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3.  Singularity  Avoidance:  Generalized  Singularity-Robust  Inverse 

Singularity  avoidance  was  implemented  per  ref  [17], [23]  for  experimental 
regulation  of  three-axis  satellite  simulator  2  (TASS2)  [3=57°  skew  angles  with 
generalized  singularity  robust  steering  law  and  quaternion  feedback  control  [52].  TASS2 
has  center-of-gravity  offset  disturbance  that  must  be  countered  by  the  three  CMG  array. 
The  testbed  was  floated  on  the  spherical  air  bearing  at  60  seconds.  The  initial  gimbal 
angles  were  [0°,  120  °,  -60  °].  The  resulting  attitude  angles  of  Figure  lshows  that  the 
system  became  unstable  after  — 150  seconds  of  regulation  (Figure  61).  Although  total 
momentum  is  with  in  the  momentum  envelop,  it  cannot  produce  more  momentum  for  a 
specific  direction,  due  to  singularity  (magnitude  of  momentum  from  each  CMG  is 
nonnalized  to  1).  Notice  the  corresponding  gimbal  angles  during  singularity  are  erratic. 
Singular  values  of  A  matrix  verify  that  singularity  avoidance  effectively  keeps  the  [A] 
matrix  from  becoming  singular,  but  it  cannot  penetrate  the  elliptical  singularity.  This  is 
the  motivation  for  alterative  singularity  reduction  and  penetration. 
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Figure  61  EXPERIMENT:  SR  Inverse  actual  attitude  Angles. 

83 


0.5 


0 


0.2 


ra 
E 
E 
o 
o 

=>  -0.2 


20 


40 


-0  5 _ i _ i _ i _ i _ i _ i _ i _ i _ 

0  20  40  60  80  100  120  140  160 

1 

0.5 
0 

-0.5 


60 


80 


100  120  140  160 


Ti 


_l _ I — 


0  20  40  60  80  100  120  140  160 

time  (sec) 

Figure  62  EXPERIMENT:  SR  Inverse  commanded  control  torque. 
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Figure  63  EXPERIMENT:  SR  Inverse  actual  control  torque. 


84 


total1 


0.5 


0 

X 

X 

-0.5 


_-|  _ i _ i _ i _ i _ i _ i _ i _ i _ 

0  20  40  60  80  100  120  140  160  180 


x 


0.5 

0 


-0.5 


-1 


0  20  40  60  80  100  120  140  160  180 


0.1 


0  - 


jVVl 


-o.i 


i 

20 


i 

40 


i-Sp, 

60 


i 

80 


i_ i_ i_ i_ i 

100  120  140  160  180 


time(sec) 


Figure  64  EXPERIMENT :  SR  Inverse  normalized  momentum. 
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Figure  65  EXPERIMENT :  SR  Inverse  normalized  momentum  magnitude. 
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Figure  66  EXPERIMENT :  SR  Inverse  gimbal  angles. 


Figure  67  EXPERIMENT:  SR  Inverse  singular  value  of  [A]  matrix. 
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4.  Singularity  Reduction  with  Decoupled  Control  Steering 

Experiments  were  performed  with  decoupled  control  to  maximum  momentum 
capability  about  the  yaw  axis.  First  note  Figure  68  displays  the  ability  of  decoupled 
control  steering  to  penetrate  the  singular  surface  associated  with  the  coupled  [A]  matrix 
of  CMG  gimbal  angles  and  skew  angle.  This  attribute  is  exploited  with  an  aggressive 
yaw  maneuver  (Figure  69).  The  commanded  maneuver  angle  from  [2]  was  increased 
700%  from  +5"  in  4  seconds  to  ±35°  in  10  seconds.  This  demands  significantly  more 
momentum  change  specifically  about  yaw.  Figure  70  displays  the  required  maneuver  is 
achieved  without  incident.  Notice  that  the  coupled  [A]  matrix  was  singular  twice  during 
this  drastic  maneuver. 


Figure  68  EXPERIMENT:  Decoupled  control. 

Demonstrate  ability  to  pass  cleanly  through  the  singular  surface  at  1H  using  proposed  decoupled  control. 

87 


time  (sec) 


Figure  69  EXPERIMENT:  Decoupled  control  yaw  angle. 

Yaw  Euler  angle  (top)  and  l/cond[A]  (bottom)  versus  time  (secs)  for  +35°  yaw  in  10  seconds,  -35°  yaw  in 
10  seconds  performed  with  decoupled  control  steering 


Figure  70  EXPERIMENT:  Decoupled  control  momentum. 

Momentum  Magnitude  (left-top)  and  l/cond[A]  (left-bottom)  versus  time  (seconds)  for  +35°  yaw  in  10 
seconds,  -35°  yaw  in  10  seconds  performed  with  decoupled  control  steering.  Note  momentum 
increase/decrease  despite  singular  [A]  matrix  with  decoupled  control.  Also,  note  the  maneuver  drastically 
exceeds  1 H  momentum. 
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Figure  71  EXPERIMENT:  Decoupled  control  gimbal  angles. 

Gimbal  angles  (top)  and  l/cond[A]  (bottom)  versus  time  (seconds)  for  +35°  yaw  in  10  seconds,  -35°  yaw  in 
10  seconds  performed  with  decoupled  control  steering.  Note  smooth  gimbal  action  despite  singular  [A] 
matrix  with  decoupled  control.  Typical  coupled  control  steering  would  have  resulted  in  loss  of  spacecraft 
attitude  control.  Instead,  with  decoupled  steering,  you  will  notice  a  nice  maneuver  despite  singular  [A] 
matrix.  Attitude  control  is  not  lost  at  any  time. 


5.  Singularity  Penetration  with  Unit  Delay 

We  see  that  singularity  reduction  is  effective.  While  SR  Inverse  was  effective  at 
avoiding  singularities,  it  could  not  follow  the  commanded  momentum  trajectory  through 
the  singularity.  Singularity  reduction  permits  momentum  trajectory  following,  but  is 
unique  to  the  optimal  singularity-free  skew  angle.  Next,  experiments  were  performed 
with  typical  coupled  control  and  singularity  penetration  algorithm,  SPUD.  In  the 
comparative  slides,  you’ll  immediately  notice  the  experiment  perfonned  without  SPUD 
was  terminated  early  (after  about  25  seconds)  to  prevent  hardware  damage  due  to  loss  of 
attitude  control.  This  demonstrates  that  with  a  coupled  system,  spacecraft  control  would 
have  been  lost  around  1H,  not  the  nearly  3H  achieved  in  the  previous  section.  For  the 
depicted  experiment  (Figure  72),  a  challenging  yaw  reversal  was  commanded  just  after 
penetrating  the  singularity  causing  the  singularity  to  be  immediately  penetrated  again. 
SPUD  penetrated  singularities  well  in  both  directions. 
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Figure  72  EXPERIMENT :  Singularity  penetration  Euler  angles. 

Yaw  Euler  angle  (top)  and  l/cond[A]  (bottom)  versus  time  (seconds)  for  +30°  yaw  in  8  seconds 
immediately  followed  by  -30°  in  8  seconds  performed  with  and  without  SPUD. 


Figure  73  EXPERIMENT:  Singularity  penetration  momentum. 

Momentum  Magnitude  (top)  and  det[A]  (bottom)  versus  time  (seconds)  for  +30°  yaw  in  8  seconds, 
immediately  followed  by  -30°  in  8  seconds  performed  with  and  without  SPUD.  Note  momentum 
increase/decrease  despite  singular  [A]  matrix  with  decoupled  control.  Also,  note  the  maneuver  drastically 
exceeds  1H  momentum. 
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Figure  74  EXPERIMENT:  Singularity  penetration  gimbal  angles. 

Gimbal  angles  (top)  and  det[A]  (bottom)  versus  time  (seconds)  for  +30o  yaw  in  8  seconds  immediately 
followed  by  -30o  in  8  seconds  performed  with  and  without  SPUD.  Note  smooth  gimbal  action  despite 
singular  [A]  matrix  with  SPUD. 


These  experiments  demonstrate  a  much  desired  goal  of  CMG  attitude  control, 
extremely  high  torque  without  mathematical  singularity  thus  without  loss  of  attitude 
control.  A  new  optimized  geometry  is  shown  to  increase  singularity-free  torque 
capability  an  order  of  magnitude.  The  maximized  singularity-free  momentum  is  rotated  to 
a  desired  by  utilizing  mixed  skew  angles.  Using  a  proposed  decoupled  control  strategy, 
further  singularity  reduction  is  achieved.  Lastly,  a  singularity  penetration  algorithm  is 
shown  to  allow  momentum  trajectories  to  cleanly  pass  through  singular  surfaces  without 
loss  of  attitude  control.  These  claims  were  introduced  analytically  and  promising 
simulations  are  provided.  Finally  experimental  verification  is  performed  demonstrating 
dramatic  yaw  maneuvers  that  pass  through  singular  surfaces  that  would  render  loss  of 
attitude  control  using  typical  coupled  control  techniques. 
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B.  TARGET  TRACKING  EXPERIMENTS 

1.  Classical  Control  Experiment 

Actual  spacecraft  inertia  (6)  components  are  unknown.  Older  estimated  inertia 
values  (prior  to  payload  installation)  are  used  for  classical  feedforward  control  design  and 
initializing  adaptive  controllers.  The  identical  acquisitions  and  target  tracking  maneuver 
simulated  above  is  commanded  on  the  Naval  Postgraduate  School’s  three-axis  satellite 
simulator  2  (TASS2).  The  methods  in  the  literature  (Slotine/Fossen)  compare  adaptive 
feedforward  and  feedback  control  favorably  to  PD  feedback  only.  This  study  will 
compare  to  the  more  realistic  classical  feedforward  with  feedback  (established  as  a 
baseline  in  Figure  75).  With  this  baseline,  the  proposed  adaptive  feedforward  controllers 
are  compared  to  this  baseline. 
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Figure  75  EXPERIMENT:  Classical  control  experiment. 

Large-angle  acquisition  maneuver  followed  by  target  tracking  trajectory:  Tracking  errors  (roll  (j),  pitch  0, 
yaw  \| /  in  degrees)  BASELINE:  Classical  feedback  +  PD  feedback  control  (Kp=100,  Kd=100). 
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2.  Adaptive  Control  Experiments 
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Figure  76  EXPERIMENT:  Euler  angle  comparison. 

Adaptive  Control  techniques  compared  for  ATP  trajectory:  A.=A.fb=l/2,  T=1 ,  K(1_200,  /.rr=l ,  Kp=100 
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Figure  77  EXPERIMENT:  Feedforward  control  comparison. 

Adaptive  Control  techniques  compared  for  ATP  trajectory:  X=A.fb=l/2,  T=l,  K<i=200,  Xff=l ,  Kp=100 
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Figure  78  EXPERIMENT:  Feedback  control  comparison. 

Adaptive  Control  techniques  compared  for  ATP  trajectory:  "K=K^=M2,  T=l,  K,p200,  Arf=l ,  Kp=100 
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Figure  79  EXPERIMENT:  Angular  rate  comparison. 

Adaptive  Control  techniques  compared  for  ATP  trajectory:  X=Xfb=l/2,  f=l ,  K(i~200,  X rf=  1 ,  Kp=100 
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Figure  80  EXPERIMENT:  Adaptive  control  comparison. 

A,=A,fb=l/2,  T=l,  Kd=200,  A,ff=l,  Kp=100  For  large-angle  acquisition  maneuver  followed  by  target  tracking 
trajectory:  Tracking  errors  (roll  4>,  pitch  9,  yaw  vp  in  degrees)  comparison:  [Slotine/Fossen]  adaptive 
feedforward  &  PD  feedback  control,  Proposed6  adaptive  feedforward  (A,ff=l)  &  PD  feedback  control, 
Proposed3  adaptive  feedforward  (Xff=  1 )  &  PD  feedback  control. 
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Figure  81  EXPERIMENT:  No  estimation  adaptive  control  comparison. 

X=Xfb=l/2,  r=l,  Kd=200,  A,fi=  1,  Kp=100 
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Figure  82  EXPERIMENT:  Inertia  estimation. 

Inertia  estimates  using  Proposed6  adaptive  feedforward  Uff+  Uft,:  T=l,  A,f^l,Kp=100,Kd=200. 
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Figure  83  EXPERIMENT:  Inertia  estimation. 

Inertia  estimates  using  Proposed3  adaptive  feedforward  Uff  +  Uft,:  r=l,  A,ff=l,Kp=100,Kd=200. 
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IV.  DISCUSSION  OF  RESULTS 


A.  PERFORMANCE 

1.  Target  Acquisition  Maneuvers  with  CMGs 

The  research  in  this  thesis  clearly  indicates  that  substantial  singularity-free 
performance  increase  can  be  achieved  using  the  3/4  CMG  skewed  array  utilizing  a  skew 
angle  of  90°.  This  skew  angle  is  designated  the  optimal  singularity  free  skew  angle. 
Singularity-free  momentum  is  increased  over  567%  (from  0.1 5H  to  1H  normalized 
magnitude).  Furthermore  it  is  shown  that  the  orientation  of  maximum  momentum  may  be 
rotated  using  mixed  skew  angles  to  orient  the  maximum  capability  along  a  preferred  slew 
direction.  The  remaining  singular  surfaces  may  be  reduced  by  decoupling  the  control 
steering  law.  1900%  performance  increase  was  shown  in  simulation  and  1500% 
performance  increase  was  experimentally  verified  using  decoupled  control  steering. 
While  decoupled  steering  is  uniquely  contributable  to  the  proposed  optimal  singularity- 
free  skew  angle,  a  more  generic  singularity  penetration  algorithm  was  also  presented.  The 
singularity  penetration  algorithm  was  tested  in  simulation  and  verified  experimentally 
with  a  difficult  commanded  trajectory  that  commands  a  reversal  of  direction  just  after 
penetrating  a  singular  surface.  The  commanded  return  immediately  penetrates  the  same 
singular  surface  again  cleanly  generating  momentum  without  loss  of  attitude  control. 


2.  Target  Tracking  with  Adaptive  Control 

Adaptive  control  for  spacecraft  fine  tracking  results  may  be  succinctly  examined 
by  narrowly  focusing  on  the  perfonnance  of  simulations  to  reveal  the  expected  dynamic 
behavior  of  the  algorithms  and  comparing  simulations  to  experimental  verification. 
Simulations  were  performed  for  a  rapid  slew  for  target  acquisitions,  and  quick  settling 
followed  by  fine  tracking  of  an  uncooperative  target.  Simulations  do  not  include  noise  or 
other  imperfections  except  purposely  under-modeled  spacecraft  inertia  (10%  and  also 
30%).  Performing  simulations  for  10%  and  also  for  30%  allow  subjective  conclusions.  Is 
a  particular  algorithm  superior  or  inferior  if  initial  inertia  estimate  is  more  accurate? 
Consider  classical  feedforward  &  PD  feedback  command  as  the  baseline,  since  it  is  most 
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typically  used  for  spacecraft  missions.  All  simulations  reveal  that  Slotine’s  method  as 
modified  by  Fossen  achieve  substantial  perfonnance  increase.  Additionally,  the  method 
exhibits  higher  percent  performance  increase  when  the  inertia  is  less  accurately  known 
(indicated  by  increased  percent  performance  increase  for  30%  inertia  error  compared  to 
1 0%  inertia  error. 

The  commanded  acquisitions,  tracking,  and  fine  pointing  (ATP)  trajectory  was 
maintained  identical  in  simulation  and  experimentation.  Recall  the  roll  axis  commands 
represents  sinusoidal  target  evasion  with  yaw  axis  representing  the  primary  acquisition 
slew  axis  and  target  run. 

Particularly  notice  no  performance  difference  is  seen  comparing  Slotine/Fossen’s 
method  neglecting  inertia  estimation  effects  (estimation  dynamics  negated  by  setting 
T=0).  Technically,  a  non-zero  difference  does  exist  on  the  order  of  10'9  degrees  per  tables 
3&4.  As  an  addendum  to  the  proposed  adaptive  control  algorithms,  it  is  noted  that 
estimation  dynamics  may  be  eliminated  completely  if  further  computational 
simplification  is  required.  Reduced  tracking  error  perfonnance  may  still  be  achieved 
simply  by  generating  the  reference  trajectory  and  adapting  the  feedforward  command 
alone  using  this  reference  trajectory  maintaining  PD  feedback. 


60  Second  ATP  simulation  10%  inertia  error:  Percent  PERFORMANCE  INCREASE 

Control  Method  (*baseline) 

-%  A  d> 

-%  A0 

-%  Av|/ 

[Classical  uff  +  KD=Kd=200]  * 

0.00% 

0.00% 

0.00% 

[Slotine/Fossen]  X=1/2,  r=1 

15.24% 

96.12% 

90.96% 

[Slotine/Fossen]  X=1/2,  r=0 

15.24% 

96.12% 

90.96% 

Derived6:  >.=  1/2,  r=1 

15.24% 

96.12% 

90.96% 

Proposed6:  %=  1 ,  r=1,  >.fb=  1 12 

17.95% 

95.81% 

91.73% 

Proposed6:  %=  1 ,  r=0,  >.fb=  1 12 

17.95% 

95.81% 

91.73% 

Proposed3:  %=  1 ,  r=1,  /.fb=  1 12 

-0.89% 

41.73% 

90.29% 

Proposed3\  %=  1 ,  r=0,  >.fb=  1 12 

-0.89% 

41.73% 

90.29% 

Table  6  SIMULATION:  10%  Inertia  error  percent  performance  increase. 
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60  Second  ATP  simulation  30%  inertia  error:  Percent  PERFORMANCE  INCREASE 

Control  Method  (*baseline) 

-%  A  (1) 

-%  A0 

-%  Av|/ 

[Classical  uff  +  KD=Kd=200]  * 

0.00% 

0.00% 

0.00% 

[Slotine/Fossen]  1=1/2,  r=1 

39.04% 

96.19% 

96.81% 

[Slotine/Fossen]  1=1/2,  F=0 

39.04% 

96.19% 

96.81% 

Derived6\  1=1/2,  F=1 

39.04% 

96.19% 

96.81% 

Proposed6\  lff=1,  F =1 ,  lfb=1/2 

40.99% 

95.89% 

97.08% 

Proposed6\  lff=1,  F=0,  lfb=1/2 

40.99% 

95.89% 

97.08% 

Proposed3\  lff=1,  r =1 ,  lfb=1/2 

27.44% 

42.77% 

96.57% 

Proposed3\  lff=1,  r=0,  lfb=  1  /2 

27.44% 

42.77% 

96.57% 

Table  7  SIMULATION:  30%  Inertia  error  percent  performance  increase. 


60  second  ATP  Experiment 

RMS  Error 

RMS  0°  Error 

RMS  v| ;°  Error 

Classical  Uff+  KD=Kd=200 

0.13440 

0.15840 

0.28190 

[Slotine/Fossen]  1=1/2,  r=1,Kd=200 

0.14900 

0.05800 

0.24800 

Proposed6 :  lff=1,  F=1,Kd=200,  lfb=1/2 

0.12400 

0.00480 

0.14500 

Proposed3 :  lff=1 ,  F=1,Kd=200,  lfb=1/2 

0.10200 

0.10300 

0.14200 

Proposed6 :  lff=1,  F=0,Kd=200,  lfb=1/2 

0.06080 

0.03470 

0.25170 

Table  8  EXPERIMENT:  RMS  errors  raw  data 


60  Second  ATP  experiment:  Percent  PERFORMANCE  INCREASE 

Control  Method  (*baseline) 

-%  A  <]> 

-%  A0 

-%  A\|/ 

[Classical  Uff  +  KD=Kd=2001  * 

0.0% 

0.0% 

0.0% 

[Slotine/Fossen]  1=1/2,  r=1,Kd=200 

-10.9% 

74.7% 

25.2% 

Proposed6\  lff=1,  F=1,Kd=200,  lfb=1/2 

7.7% 

114.3% 

101.9% 

Proposed3\  lff=1,  F=1,Kd=200,  lfb=1/2 

24.1% 

41.2% 

104.1% 

Proposed6\  lff=1,  F=0,Kd=200,  lftj=1/2 

54.8% 

92.0% 

22.5% 

Table  9  EXPERIMENT:  percent  performance  increase  in  RMS  errors. 


a.  Alternative  for  Future  Comparison:  Projection  Algorithm 

Elimination  of  estimation  is  desirable  due  to  the  checkered  history  of 
adaptive  control  failures  due  to  parameter  drift.  Model  reference  adaptive  control 
(MRAC)  methods  were  shown  by  Rohrs  to  be  unstable  for  unmodeled  flexible  dynamics 
(e.g.  a  pair  of  high  frequency  unmodeled  zeros).  While  MRAC  adapted  in  gain,  it  did  not 
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in  phase  permitting  instability.  Very  recently,  Cao  and  Havakimyan  [55], [56]  formulated 
modifications  to  the  MRAC  adaptive  control  to  solve  the  issue.  It  is  shown  that  for 
convex  functions  of  estimation  dynamics,  the  estimation  rate  may  be  modified  to  include 
a  projection  function  that  prevents  parameter  drift  beyond  a  defined  boundary.  In  this 
thesis  estimate  drift  was  addressed  by  striving  to  eliminate  the  estimation  resulting  in  a 
robust  feedforward  control  approach  with  PD  feedback  control.  In  instances  where 
estimation  must  be  maintained,  this  projection  algorithm  seems  promising,  but 
insufficient  time  was  available  to  implement  it  here.  The  projection  algorithm  guarantees 
that  the  estimates  will  remain  in  a  set:  fl  =  {0;/(0)  <  1}  where  the  convex  function  is 


y 


V/(0) 


'  ./((■>)  =  c<t 

Figure  84  Illustration  of  the  projection  operator. 


The  estimation  rate  dynamics  law  then  becomes: 


0  =  Proj(y,0) 


(68) 


(69) 
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For  a  convex  compact  set  with  a  smooth  boundary  condition  given  by 
Q5|0c  i"  /'(0) <c|.  0<c<l.  This  projection  algorithm  allows  estimates  to 
wander  until  they  hit  the  boundary  where  they  stay. 

B.  IMPLEMENTATION  ISSUES 

1.  Target  Acquisition  Maneuvers  with  CMGs 

While  the  singularity  penetration  algorithm  has  been  presented  and  demonstrated 
to  be  effective,  the  engineer  is  left  with  the  task  of  deciding  when  to  activate  the 
singularity  penetration  algorithm.  In  this  research,  engagement  was  based  on  first 
simulating  the  planned  trajectory  and  noting  the  value  of  det[A]  when  singularity-like 
behavior  is  observed.  The  singularity  penetration  is  then  set  to  engage  prior  to  this 
critical  value  of  det[A].  Since  the  value  varies  with  planned  maneuver,  a  more  generic 
criteria  is  desired.  Consider  using  two  conditions:  when  det[A]  reaches  a  low  value 
(much  looser  than  implemented  here),  and  also  when  commanded  gimbal  rates  reach 
saturation.  As  a  CMG  approaches  an  angle  such  that  it  can  no  longer  generate  momentum 
in  a  commanded  direction,  commanded  gimbal  rates  increase.  When  saturation  is 
reached,  the  det[A]  value  continues  to  decrease,  but  for  all  essentially  purposes  the  array 
is  singular  since  the  gimbal  rates  have  saturated. 


2.  Target  Tracking  with  Adaptive  Control 

It  has  been  discussed  that  real  world  issues  (e.g.,  noise)  complicate  actual 
application  of  many  promising  advanced  algorithms.  Notice  in  all  of  the  regression 
models  used  in  the  adaptive  algorithms,  angular  rate  measurements  are  differentiated. 
There  is  no  such  device  that  measures  inertia  angular  acceleration,  so  the  noisy  rate  gyro 
measurements  must  be  computationally  differentiated,  an  inherently  noise-magnifying 
procedure.  This  is  a  fundamental  weakness  of  the  regression/estimation  approach  to 
adaptive  control.  Engineers  typically  use  classical  feedforward  and  feedback  controls. 
This  research  suggests  adapting  the  feedforward  trajectory  alone  can  improve  system 
performance  while  reducing  the  amplification  of  noise  in  real  world  sensors  and  systems. 

IV. 
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V.  CONCLUSIONS  AND  FUTURE  WORKS 


Target  acquisitions,  tracking  and  fine  pointing  (ATP)  is  a  challenging  mission  for 
military  spacecraft.  Large-momentum  slew  maneuvers  of  spacecraft  with  short  settling 
times  while  maintaining  fine  pointing  requirements  present  considerable  challenges  to 
conventional  spacecraft  designs.  The  large  slew  acquisition  maneuver  often  dictates 
utilizing  control  moment  gyroscopes  for  momentum  exchange  (torque),  but  singularities 
complicate  actual  implementation.  In  this  dissertation  an  alternative,  actuator 
configuration  is  proposed  yielding  significant  increase  in  singularity-free  momentum 
generation.  This  alternative  configuration  is  demonstrated  to  be  the  optimum  CMG  skew 
angle  for  singularity  free  momentum  generation.  This  allows  spacecraft  to  slew  much 
more  rapidly  and  settle  faster  with  larger  control  torques  available.  Secondly,  it  is  shown 
that  the  direction  of  maximum  singularity-free  momentum  may  be  rotated  to  a  desired 
direction  using  mixed  skew  angles.  Even  in  the  optimum  configuration,  some 
singularities  still  exist  and  are  addressed  in  the  third  new  contribution  presented  here. 
Thirdly,  these  remaining  singularities  may  be  reduced  with  a  proposed  decoupled  control 
steering  technique  that  is  unique  to  the  optimum  singularity-free  skew  angle.  Fourthly,  a 
new  singularity  penetration  algorithm  is  presented  that  has  the  potential  to  grant 
maximum  array  torque. 

Following  the  rapid  slew  target  acquisition  maneuver,  non-cooperative  targets 
must  be  tracked  with  high  pointing  accuracy  despite  disturbances  and  un-modeled 
dynamics  including  poorly  estimated  inertia.  During  the  demanding  military  mission, 
poorly  modeled  inertia  limits  tracking  performance.  One  indirect  adaptive  control  method 
has  been  suggested  in  the  literature,  but  was  derived  in  the  inertial  frame  resulting  in 
unwieldy  computations.  Additionally,  the  method  was  only  compared  to  feedback  control 
alone.  An  addendum  suggested  derivation  in  the  body  frame,  but  did  not  derive  the 
method  for  spacecraft  attitude  control.  The  fifth  contribution  presented  here  derives  the 
method  for  spacecraft  attitude  control  and  critically  compares  the  results  to  typical 
feedforward  +  feedback  control. 
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The  sixth  new  contribution  presented  here  introduces  a  new  simpler,  nonlinear, 
indirect  adaptive  feedforward  control  technique  to  estimate  the  actual  inertia  and  reduce 
tracking  errors.  It  is  shown  to  grant  superior  performance  to  typical  feedforward  + 
feedback  control  as  well  as  the  adaptive  control  methods  in  the  literature.  Since  nonlinear 
adaptive  control  methods  can  often  become  cumbersome,  two  additional  new  simplified 
techniques  (reduced  order)  are  shown  to  grant  similar  reduction  in  tracking  errors 
presented  as  sixth  and  seventh  suggested  contributions.  The  ninth  and  final  new 
development  suggested  here  is  an  alternative  reference  trajectory  robust  fixed  gain 
feedforward  technique  that  does  not  require  estimation,  but  retains  target  tracking 
performance  increase.  Stability  analysis  of  this  final  technique  remains  a  “future  work.” 
Taken  together,  military  spacecraft  have  several  new  options  available  to  address  target 
acquisition,  tracking  and  fine  pointing. 

Finally,  it  can  not  be  understated  that  experimental  verification  is  included  for  all 
new  methods  suggested  here.  Actual  experimental  implementation  can  often  confound 
the  most  elegant  mathematical  formulations.  In  theory,  it  is  shown  that  15-91% 
performance  increase  is  possible  with  -10%  inertia  error,  and  39-97%  perfonnance 
increase  is  possible  with  -30%  inertia  error  (for  the  case  of  the  estimated  inertia  of  the 
three-axis  spacecraft  simulator  at  the  Naval  Postgraduate  School).  In  actual  experiments, 
7-114%  performance  increase  was  achieved  noting  the  actual  error  in  inertia  estimates  is 
unknown.  Regarding  large  momentum  acquisitions  maneuvers,  experimental  verification 
is  crucial  since  a  singularity  may  result  is  complete  loss  of  attitude  control.  Experimental 
results  were  presented  verifying  near-maximum  momentum  generation  without  loss  of 
attitude  control. 

Future  works  also  include  implementation  of  these  techniques  on  a  flexible  multi¬ 
body  spacecraft.  This  research  assumed  a  rigid  spacecraft,  while  the  current  trend  in 
spacecraft  construction  results  in  lighter,  more  flexible  structures.  As  a  matter  of  fact, 
current  spacecraft  have  become  so  flexible,  that  their  lowest  natural  frequency  lies  within 
the  bandwidth  of  typical  attitude  controllers.  This  is  referred  to  as  controls-structures 
interaction,  where  simply  commanding  any  maneuver  is  guaranteed  to  excite  resonant 
vibration  in  the  spacecraft.  This  is  extremely  challenging,  and  the  advanced  control 

techniques  proposed  here  should  be  modified  to  account  for  structural  interaction. 
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APPENDIX 


A.  CMG  SINGULARITY  PLOT  MATLAB  CODE 

1.  MATLAB  Program  Plot  Singular  Surfaces 

%  3/4  CMG  Singularity  Surfaces  TA  Sands 

%  This  file  plots  points  at  the  magnitude  of  angular  momentum  at  singular  points 
%  The  points  form  a  singular  surface 
clear  all;close  all;clc; 

%  Enter  skew  angles  of  each  CMG:  skewl,  skew2,  skew3. 

CMGskew=5  4.73;  %  ENTER  SKEW  ANGLE  HERE 

skew=CMGskew*pi/180;  %convert  degrees  to  radians  for  computer  calculation 

skewl=skew;skew2=skew;skew3=skew;  %Assigns  values  for  each  individual  CMG  skew  angle 

%  Create  gimbal  axis  unit  vectors  each  CMG 

gl=[-sin(skewl)  0  -cos(skewl)]';  g2=[0  -sin(skew2)  -cos(skew2)]';  g3=[sin(skew3)  0  -cos(skew3)]'; 

%  Create  matrix  of  singular  vectors  called  "[normal]"  varying  2  angles  from  0  to  2pi  covering  3D  space 
normal=discretize_function;  %Surface  created 

%  2  possible  singular  points  exist  for  each  (+  or  -)  Singular  (normal)  vectors 
%Establish  vector  directions  for  normal  vectors  (+++  or  — ) 

el=-l;  e2=-l;  e3=-l;  Hs_plus_plus_plus=momentum_function(gl,g2,g3, el, e2,e3, normal); 
%Hs_plus_plus_plus=[Hs_plus_plus_plus(l,l:1000);Hs_plus_plus_plus(2,l:1000);Hs_plus_plus_plus(3,l: 
1000)] 

%Establish  vector  directions  for  normal  vectors  (+-+) 

el=l;  e2=-l;  e3=l;  Hs_plus_minus_plus=momentum_function(gl,g2,g3,el,e2,e3,normal); 

%Establish  vector  directions  for  normal  vectors  (+--) 

el=l;  e2=-l;  e3=-l;  Hs_plus_minus_minus=momentum_function(gl,g2,g3, el, e2,e3, normal); 

%Establish  vector  directions  for  normal  vectors  (++-); 

el=l;  e2=l;  e3=-l;  Hs_plus_plus_minus=momentum_function(gl,g2,g3, el, e2,e3, normal); 

%  Plot  Singular  Surfaces  for  all  4  cases:  +++  or  — ,  +-+,  +— ,  and  ++- 

PlotSingularSurfaces_function(Hs_plus_plus_plus,Hs_plus_minus_plus,Hs_plus_minus_minus,Hs_plus_pl 
usminus,  CMGskew) ; 

2.  Discretization  Function  Code 

function  [normal]  =  discretize; 

angle  1  =linspace(-pi,pi/2, 101);  angle2=linspace(0,2  *pi,  1 0 1 );  index=0; 

for  i=l:length(anglel); 

for  j=l  :length(angle2);  index=index+l; 

normal(:,index)=[cos(anglel (i))*cos(angle2(j));  cos(angle  1  (i))*sin(angle2(j ));  sin(angle  1  (i))]; 
end 
end 


3.  Momentum  Function  Code 

function  [Hs]  =  momentum(gl,g2, g3, el, e2,e3, normal) 

for  i=T:length(normal); 

%Cross  product  gimbal  1,2,3  unit  vectors  and  singular  (normal)  vectors 
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g  1  Xnormal=cross(g  1  .normal  (:.i));  g2Xnormal=cross(g2,normal(:,i)); 

g3Xnormal=cross(g3,normal(:,i)); 

%  Calculate  the  angular  momentum  (Hxs,Hys,Hzs)  at  each  singular  point 

Hs( :  ,i)=e  1  *(cross(g  lXnormal,g  1 )/ sqrt(g  1  Xnormal'*g  lXnormal))  + 

e2*(cross(g2Xnormal,g2)/sqrt(g2Xnormar*g2Xnormal))  + 

e3*(cross(g3Xnormal,g3)/sqrt(g3Xnormar*g3Xnormal)); 
end 


4.  Plot  Singular  Surfaces  Function  Code 

function  PlotSingularSurfaces(Hs_plus_plus_plus,Hs_plus_minus_plus,Hs_plus_minus_minus,Hs_plus_plus_minus,CMGskew); 

CMGskewAngle=['CMG  skew  angle  =  ',num2str(CMGskew),'Ao']; 

figure(l);subplot(2,2,l);plot3(Hs_plus_plus_plus(l,:),Hs_plus_plus_plus(2,:),Hs_plus_plus_plus(3,:),'o,,'MarkerSize,,0.1); 

axis([-3,3,-3,3,-3,3]);xlabel('x');ylabel(y);zlabel('z’);  title('Singular  Vectors  for  +++');text(-2.5,2.5,3,CMGskewAngle); 
subplot(2,2,2);plot3(Hs_plus_minus_plus(l,:),Hs_plus_minus_plus(2,:),Hs_plus_minus_plus(3,:),'oVMarkerSize',0.1); 
axis([-3,3,-3,3,-3,3]);xlabel('x');ylabel(y);zlabel('z’);  title('Singular  Vectors  for  +  -  +');text(-2.5,2.5,3,CMGskewAngle); 
subplot(2,2,3);plot3(Hs_plus_minus_minus(l,:),Hs_plus_minus_minus(2,:),Hs_plus_minus_minus(3,:),'oVMarkerSize',0.1); 
axis([-3,3,-3,3,-3,3]);xlabel('x');ylabel(y');zlabel('z');  title(' Singular  Vectors  for  +  -  -’);text(-2.5,2.5,3,CMGskewAngle); 
subplot(2,2,4);plot3(Hs_plus_plus_minus(l,:),Hs_plus_plus_minus(2,:),Hs_plus_plus_minus(3,:),'oVMarkerSize',0.1); 
axis([-3,3,-3,3,-3,3]);xlabel('x');ylabel(y);zlabel('z');  title(' Singular  Vectors  for  ++  -f);text(-2.5,2.5,3,CMGskewAngle); 

figure(2);plot3(Hs_plus_minus_plus(l,:),Hs_plus_minus_plus(2,:),Hs_plus_minus_plus(3,:),'oVMarkerSize',0.1);hold  on 
plot3(Hs_plus_minus_minus(l,:),Hs_plus_minus_minus(2,:),Hs_plus_minus_minus(3,:),'roVMarkerSize',0.1); 
plot3(Hs_plus_plus_minus(l,:),Hs_plus_plus_minus(2,:),Hs_plus_plus_minus(3,:),'moVMarkerSize',0.1);hold  off 

xlabelfx^jylabelCy'Jjzlabelfz'JjtitleCIntemal  Singular  Surfaces  for  3/4  CMG  Array','fontsize',16);axis([-3,3,-3,35-3,3]);text(- 

1,1,3  ,CMGskew  Angle); 

figure(3);plot3(Hs_plus_plus_plus(l,:),Hs_plus_plus_plus(2,:),Hs_plus_plus_plus(3,:),'co',,MarkerSize',0.1);hold  on 
plot3(Hs_plus_minus_plus(l,:),Hs_plus_minus_plus(2,:),Hs_plus_minus_plus(3,:),'o','MarkerSize,,0.1); 
plot3(Hs_plus_minus_minus(l,:),Hs_plus_minus_minus(2,:),Hs_plus_minus_minus(3,:),'roVMarkerSize',0.1); 
plot3(Hs_plus_plus_minus(l,:),Hs_plus_plus_minus(2,:),Hs_plus_plus_minus(3,:),'moVMarkerSize',0.1); 
xlabelfx'JjylabelCyjjzlabelfz'JjtitleCSingular  HyperSurface  for  3/4  CMG  ArrayVfontsize',16); 

axis([-3 ,3  ,-3 ,3  ,-3 ,3]);text(- 1,1,3  ,CMGskewAngle);hold  off 
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B.  SKEW  ANGLE  INTERATED  SINGULAR  SURFACES 
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C.  ADAPTIVE  FEEDFORWARD  CONTROL 

Slotine’s  Regression  matrix  of  “knowns”  implemented  in  the  inertial  frame  to  be 
compared  with  Fossen’s  improvement  in  equation  32. 

0(1,1)  =  Jxx  Components  of  [0]{(9}(1,1) 


<fi  -  y/  sin  9  +  (cos  <p(j)  tan  9  +  sin  (f>  sec2 


+ 


sin  #(cos  0  cos  (fxf)  +  sin  (j)  sin  96)  cos  (j) 
cos2  ^(sin  9  sin  (f>  +  cos2  (j)) 


+  ... 


9 


l  sin  9(-  cos  #  sin  M  +  cos  6  sin  99)  sin  (h 
.  +  (sin  (f>  sin  (f)  tan  9  +  cos  (f>  sec  9) - - - ~ - - - - — “ — - ~ 

cos  ^(sin  9  sin  (f>  +  cos2  (j)) 


9 


2  2 

(cos  (jxp  tan  9  +  sin  (j)  sec  99)  sin  9  cos  9  sin  ^(cos^cos^  +  sin^sin^) 
sin  0sin^  +  cos2  ^  cos  #(sin0sin^  +  cos2  </>) 

(sin  (/)(/)  tan  9  +  cos  $  sec2  9)  cos  9  cos  (/>  sin  9(-  cos  9  sin  (jxj)  +  cos  ^  sin  99)  cos  (/> 


¥ 


sin  9  sin  (/>  +  cos’  (j) 


cos 


9  (sin  9  sin  (/>  +  cos2  cf} 


¥ 


0(1,2)  =  J xy  Components  of  [O] {<9}  (1,1) 


cos  (j)9  -  sin  9  cos  9y/ 
sin  9  sin  (j)  +  cos2  (f) 


+ 


cos  (f)  sin  (fxf)  +  tan  9{ cos  9  cos  (/)(/)  +  sin  (f)  sin  99) 


(sin  9  sin  <j)  +  cos°  (f> )2 


COS  (/)  +  ... 


9 


cos  (j)  cos  99  -  tan  9(-  cos  9  sin  (f>(f)  +  cos  (j)  sin  99) 


( sin  <9  sin  0  + cos2 


sin^ 


9 


cos  (h  sin  66  +  tan  #(cos  9  cos  66  +  sin  6  sin  99)  .  _ 

- - ism6)cos6,  +  ... 


(sin6>sin^  +  cos2^) 


¥ 


cos  (j)  cos  99  -  tan  9(-  cos  9  sin  (/)(/)  +  cos  (j)  sin  99) 


(sin  9  sin  (/)  +  cos2 


cos  9  cos  (j) 


¥ 
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+  -  sin  0  cos2  0  cos  00  -  cos2  0{-  cos  6  sin  00  +  cos  0  sin  00) 

(sin Osm0  +  cos2  0} 

0(1,4)  =  J  vy  Components  of  [O]{0}(1,1)  =  0 

0(1,5)  =  Jyz  Components  of  [0]{#}(1,1)  =  0 
0(1,6)  =  Jzz  Components  of  [O]{0}(1,1)  =  0 
0(1,7)  =  Hx  Components  of  [O] {<9}  (1, 1)  =  0 

0(1,8)  =  Hy  Components  of  [O]  {6}  (1, 1)  = 

0(1,9)  =  H  Components  of  [Oil#}  (1,1)  =  cos^+sm^cos^ 

_ 5 _ L  J  v  J _  sin  6  sin  0  +  cos 0 

0(2,1)  =  Jxx  Components  of  [O]  {6^}  (2, 1)  =  0 
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0(2,2)  =  Jxy  Components  of  [0]{<9}(2,1) 


cos  (fxf)  -  cos  (f)  sin  Oy/ 
sin  0  sin  (f)  +  cos2  (j) 


+ 


(— cos^  (j)  —  cos2  ^sin^Xcos^tan^  +  sin^sec^  00) 


cos'  #(sin  6  sin  </>  +  cos2  (j))2 


+  ... 


0 


cos  (f)  sin  ^(sin  (fxf)  tan  0  +  cos  (f>  sec^  0)  cos  (f>  sin  0  sin  (/){- cos  6  sin  (fxf)  +  cos  (j)  sin  00) 


cos2  #(sin  0  sin  <f>  +  cos2  (f) )2 


cos2  #(sin  0  sin  (f>  +  cos2  (j))2 


0 


-  cos  (j)  sin  0  cos  0  -  cos  (j)  sin2  0  cos  0( cos  (fxf)  tan  0  +  sin  (j)  sec2  66) 
cos2  <9(sin  6  sin  (f  +  cos2  (j))1 


¥ 


-  cos2  (j)  cos  6(-  sin  (fxf)  tan  6  +  cos  q i  sec2  6)  -  cos2  q i  cos  6  sin  6(-  cos  6  sin  (fxf)  +  cos  (j)  sin  66) 

cos2  ^(sin  6  sin  <f>  +  cos2  (f))2 


¥ 


0(2,3 )  =  JXZ  Components  of  [0]{#}(2,1) 


-  sin  (fxj)  -  sin  (f>  sin  Oy/ 


+ 


(sin2  (fxf)  cos  (f)  -  sin  <f)  sin  0  cos  ^)(cos  (fxf)  tan  0  +  sin  <f)  sec2  60)  + . . . 


sin  <9  sin  0  + cos  ^  |_  cos2  6l(sin6,sin^  + cos  ^)2 

...-sin2  ^(sin  tan  <9  + cos  0  sec2  60  +  sin2  (f) sin 0{- cos 0 sin (fxf>  +  cos 0 sin 00) 

cos2  <9(sin  0  sin  0  +  cos2  <f>)2 


0 


0 


(-  sin  (f>  sin  6  cos  6  +  sin  0  sin2  6  cos  ^)(cos  (fxf)  tan  6  +  sin  (f>  sec2  66)  - 
cos2  ^(sin  6  sin  0  +  cos2  (f))2 


¥ 


.  +  sin  (f)  cos  0  cos  0(- sin  00  tan  0  +  cos  (f>  sec2  0)  +  sin  (f>  sin  0  cos  0  cos  0(-  cos  0  sin  (f)(f)  +  cos q i i  sin  00) 

cos2  <9(sin  0  sin  0  +  cos2  (j))2 


¥ 


0(2,4)  =  J yy  Components  of  [O]  {<9}  (2, 1) 


cos2  (f)0  +  cos  (f)  sin  Oy/ 
sin  0  sin  0  +  cos2  (f) 


+ 


(cos3  (f) sin (fxj)  +  cos2  0sin<9cos6,Xcos00tan6,  +  sin0sec2  00)  + ... 


cos"  <9(sin  0  sin  (f>  +  cos'  (j) ) 


0 


...  -  cos2  (f)  cos  00  sin  <f)  +  cos  0  sin  0  cos  0  sin  0(-  cos  0  sin  (fxf)  +  cos  q i  sin  00) 

cos2  <9(sin  0  sin  (f>  +  cos2  0)3 


0 
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cos2  p sin pp sin  6 cos  9  +  cosp sin2  6 cos2  ^(cos^tan^  +  sin^sec2  66)  +  ... 
cos2  ^(sin  6  sin  p  +  cos2  pf 


¥ 


.  +  cos3  p  cos2  90  -  cos2  p  sin  0  cos2  9(- cos  9  sin  pp  +  cos  p  sin  99) 
cos2  6*(sin  9  sin  p  +  cos2  pf 


V 


0(2,5)  =  J yz  Components  of  [0]{<9}(2,1) 


-2  sin  p  cos  p9  +  (-  sin  p  sin  9  cos  9  +  cos3  p  cos  9)\j/ 
sin  9  sin  p  +  cos2  p 


+ 


-sin2  p cos2  pp-cos1  pcos1  pp  + .. . 
cos2  <9(sin  9  sin  p  +  cos2  0)3 


9 


...  +  (-  sin  (/>  sin  6  cos  6  cos  (j)  +  cos3  </>  cos  0)(cos  (f><l>  tan  9  +  sin  (j>  sec2  99)  sin2  <j>  cos  <f>  cos  99  +  cos  (j)  cos  99  sin  (j>  + . . . 

cos2  0(sin  9  sin  <j>  +  cos2  (f)  f 


.  +  (-  sin2  (f)  sin  9  cos  9  +  cos3  (f)  cos  9  sin  (/>){- cos  9  sin  (/)(/)  +  cos  (f)  sin  99) 
cos2  6*(sin  9  sin  (j>  +  cos2  (/)  f 


9 


-  sin2  ^  cos  (jxj)  sin  6  cos  6  -  cos  (j)  sin  (pep  sin  6  cos  6  + ... 
cos2  ^(sin  6  sin  (p  +  cos2  (p) 


¥ 


22  2  ^  22 

.  -  (sin  (p sin'  9  cos"  9  +  cos  (p  cos"  9  cos  (p  sin  6l)(cos  (p(p  tan  9  +  sin  (p sec"  99)  -  sin  (p  cos"  (p  cos'  99  + ... 

cos2  6*(sin  9  sin  (p  +  cos2  (p ) 

.  +  (-  sin  (p  sin  9  cos  9  +  cos2  (p  cos  9)(-  cos  9 sin  pep  +  cos  (p  sin  99){ cos  9  cos  <p) 

cos2  ^(sin  9  sin  (p  +  cos2  <p) 


¥ 


0(2,6)  =  Jzz  Components  of  [0]{6^}(2,1) 


sin2  (pO  -  sin  ep cos  9  cos  py/ 
sin  9  sin  p  +  cos2  p 


+ 


(sin3  pp  cos  p  -  sin  p  cos  9  cos2  0)(cos^tan<9  +  sin^sec2  99)  +  ... 
cos2  6*(sin  0  sin  p  +  cos2  pf 


9 


...  -  sin3  p  cos  99  -  sin 1  p  cos  9  cos  p{ -  cos  9  sin  pp  +  cos  p  sin  99) 


cos2  <9(sin  9  sin  p  +  cos2  p )3 


9 


sin3  pp  cos  p-  sin  6  cos  6  cos2  ^(cos^tan^  +  sin^sec2  96)  +  .. 


cos  ^(sin  6  sin  p  +  cos"  p) 


¥ 
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.-sin2  (f>cos  00 cos</)  +  (sm(f)cos  6* cos2  ^X-cos^sin^  +  cos^sin^) 
cos2  <9(sin  0  sin  (j>  +  cos2  0)3 


¥ 


<5(2,7)  =  Hx  Components  of  [<5]{g}  (2,1)  =  sin(*sinecose~cos;(*c°s^ 

-  (sin  0  sin  (/)  +  cos2 

0(2,8)  =  Hv  Components  of  [<P]  {6>}  (2, 1)  = 

0(2,9)  =  H.  Components  of  [0]{6>} (2,1)  = 

0(3,1)  =  J„  Components  of  [o] \0't  (3,1) 


-  sin  (jxj)-  sin2  Oy/  + 


sin  #(cos  (/>(/)  tan  0  +  sin  <j)  sec2  00)  sin  (f>j>  cos  <j)  +  sin  <9(cos  0  cos  (j>$  +  sin  ^  sin  00)  cos  </>  +  ... 

cos2  (9(sin(9sin^-t-cos2  </>) 


0 


. . .  +  sin  <9(-  sin  (jxj)  tan  0  +  cos  (f)  sec2  0)  cos  00  sin  <j)  +  sin  <9(-  cos  </></>  + cos  (f)  sin  00) 

cos2  <9(sin  0  sin  (f>  +  cos2  (f>) 


0 


sin  0(cos  H> tan  0  +  sin  (/>  sec2  00)  sin  0  cos  0  -  sin  0{cos  0  cos  (jxj)  +  sin  (/>  sin  00)  sin  0  cos  0  - 

cos2  0(sin  0  sin  </>  +  cos2  <f>) 


¥ 


sin  0{- sin  </xj)  tan  O  +  cosc/)  sec2  <9)cos2  00  c os  ^  + sin2  0(-cos<f>fi  +  cos00) 
cos2  0(sin  0  sin  (f>  +  cos2  </>) 


¥ 


0(3,2 )  =  Jxy  Components  of  [0]{#}(3,1) 


sin  0  cos  0(j>  -  sin  0  cos  (/> 0  +  (sm^&tosO  -  syai-OtosO  )y/ 
sin  0  sin  cj>  +  cos2  (j> 

sin^cos^Ccos^tan^  +  sin^sec2  <9<9)  sin  cos  sin  <9  cos2  0sin00  + ... 

cos2  <9(sin  0  sin  0  +  cos2  (j))2 

sxa^Sos 0  +  0¥-OtosO) cos 0 cos 00  +  sin 0sin 00 cos (f>  +  ...  ^ 
cos2  <9(sin  0  sin  0  +  cos2  0)2 
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.  +  sin2  0  cos  0{— sin  (f)(j)  tan  6  +  cos  (f)  sec2  6)6  -  sin  0  cos  (/)  cos  60  + . . . 
cos2  <9(sin  6  sin  (f>  +  cos2  </>)2 


6 


.  +  (-  sin  6  cos  6(- sin  (f>(f>  tan  6  +  cos  (f)  sec2  6)  -  sin  6  cos  (j))  cos  60  sin  <f)  +  . .. 
cos2  <9(sin  6  sin  (j>  +  cos2  (/> )2 


6 


.  +  {-^x^&co^O  +  _§in^#eos^  )(cos  (fxfi  +  cos  (f)  sin  00) 
cos2  ^(sin  0  sin  (f>  +  cos2  0)2 


6 


-  sin2  0  cos2  0( cos  (jx/)  tan  6  +  sin  ^  sec2  00)  -  sin2  0  cos  (/)  sin  </rf>  cos  0  - 
cos2  ^(sin  0  sin  (j)  +  cos2  (j))1 


¥ 


(ji&i#cos 'O  -  ^s^osSsO  )(cos  0  cos  (j)(j)  +  sin  (j)  sin  00)  sin  0  cos  0 
cos2  ^(sin  0  sin  (j)  +  cos2  (j))1 


¥ 


-  sin  0  cos2  00(- sin  <fxf>  tan  0  +  cos  (j)  sec2  0)  -  sin  0  cos  (j)  cos  00 
cos2  ^(sin  0  sin  (j)  +  cos2  (j))2 


¥ 


{-^a^-O^ofO  +  ^ini#e6s ~0){  -  cos  0  sin  <p<j)  +  cos  (j)  sin  00) 
cos2  ^(sin^sin^  +  cos2  </>)2 


¥ 


0(3,3)  =  Jxz  Components  of  [®]{#}(3,1) 


cos  0  cos  (jxp  -  sin  0  sin  c/)6  +  (-  cos  0  cos  (j)  sin  0  -  sin  (/)  cos  0  cos  (/>)y/ 
sin  0  sin  (j)  +  cos2  $ 

-cos  6  cos2  0(cos^tan6*  +  sin  ^  sec2  60)  sin  </><j)  cos  (j)-  cos  6  cos3  (j)  sin  (/)(/)  +  sin  6  sin2  ^cos^  +  ... 

cos2  6*(sin  6  sin  (f)  +  cos2  (j))1 

...  +  (- cos^ees^^Tsm^  +  ^m^cosi^os^) cos 6 cos </>())  +  sin (f> sin 60  +  ...  ^ 

cos2  ^(sin  0  sin  (j)  +  cos2  <f i)2 


. . .  +  cos2  6  cos  <f)6  sin  (j)(- sin  (j)(f)  tan  6  +  cos  (j)  sec2  6)0  -  sin  0  cos  (j)  cos  60  sin  (j)  + . . . 

cos2  6*(sin  0  sin  (j)  +  cos2  (j))2 

+  jmiJic©s#Cos^)(-cos#sin^  +  cos0sin##)  ^ 
cos2  #(sin  0  sin  (f>  +  cos2  (j) )2 
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-cos3  0cos2  (/>(- sin </></> tan #  +  cos^ sec2  ^-sin^cos2  ##cos^  +  ... 
cos2  0(sin  9  sin  </)  +  cos2  (j))2 


¥ 


(-  cos  9  cos  (j)  sin  9  -  sin  9  cos  9  cos  (/>){- cos  (j)  sin  (jxj)  +  cos  </>  sin  99) 
cos2  ^(sin  0  sin  (j)  +  cos2  (j))2 


¥ 


0(3,4)  =  J yy  Components  of  [®]{#}(3,1) 


n  n  J.n  SVrOO  COS2  0 

sin  0  cos  0  cos  (pO  H - , —  y/ 

sin  6  sin  ^  +  cos”  (/) 

sin  9  sin  ^  +  cos2  (j) 

-  sin  9  cos  0  sin  (/)(/)  cos  (j)  -  sin2  0  cos2  6*(cos  0  cos  (f)^  +  sin  (f>  sin  00)  cos  (f)  +  sin  0  cos2  0  cos  (f)0  sin  (j)  + . 

cos2  <9(sin  0  sin  (f>  +  cos2  (f> )3 

...  -  sin  <9  sin  ^  sin  <9  cos  6*(-  cos  6*  sin  +  cos  ^  sin  00) 


cos2  <9(sin  0  sin  0  +  cos2  (j))2 


0 


sin2  9  cos2  9  cos  0  sin  00-  sin3  9  cos3  #(cos  9  cos  00  +  sin  0  sin  99)  +  sin#  cos3  0cos2  (j)9  +  ... 

cos2  ^(sin  9  sin  0  +  cos2  q b )3 

sin2  #cos2  9{- cos  9  sin  00  +  cos  0  sin  99)  . 
cos2  ^(sin  9  sin  0  +  cos2  0)3 


0(3,5)  =  Jyz  Components  of  [®]{#}(3,1) 


(cos  9  cos2  0  -  sin  9  cos  9)9  +  (cos2  9  cos  0  sin  9  +  sin  9  cos2  9  cos  (/>)y/ 
sin  9  sin  0  +  cos2  0 

cos  0  cos3  0  sin  00  -  sin  0  cos  0  sin  00  cos  0-  cos2  6*  cos2  0sin<9(cos<9cos00  +  sin  (j)  sin  00)  + ... 

cos2  <9(sin  0  sin  0  +  cos2  0)3 

sin  0  cos2  0  cos2  0(cos<9cos00  +  sin  0  sin  <9<9)  +  cos2  0  cos2  0<9  sin  0  -  sin  0  cos2  0  sin2  0<9  + ... 


0 


cos2  <9(sin  0  sin  0  +  cos2  (j))2 

.  +  (cos2  0  cos2  0  sin  0  +  sin  0  cos2  0  cos2  0)(-  cos  0  sin  (j)(j)  +  cos  0  sin  00) 


0 


cos2  ^(sin  0  sin  0  +  cos2  0)3 


0 
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cos2  9  cos  (/)  sin  (jxj)-  sin2  #cos2  #sin2  ^-cos3  9  cos  (/)  sin2  ^(cos^cos^  +  sin^sin##)- 

cos2  ^(sin  9  sin  (j)  +  cos2  ^)3 

.  +  cos3  9  cos3  c/)6  +  cos2  9  cos  (j)  sin  9(-  cos  9  sin  <p<p  +  cos  (j)  sin  99) 
cos2  ^(sin  9  sin  ^  +  cos2  c/)f 


0(3,6)  =  J zz  Components  of  [®]{#}(3,1) 


cos  9  cos  (j)  sin  (j>0  +  cos2  9  cos2  (fry/ 
sin  9  sin  ^  +  cos2  (fr 

cos6*cos2  ^sin2  ^-cos2  6 cos3  ^(cos 0 cos (fr(fr  +  sin (fr sin 06) -cos2  9 cos (fr sin2  (frO  +  ... 

cos2  ^(sin  9  sin  (fr  +  cos2  (fr)7. 


...  +  cos2  6  cos2  (j){-  cos  6 sin  (fxfr  +  cos  (fr  sin  09) 


cos2  <9(sin  9  sin  (fr  +  cos2  (fr)7 


9 


9 


-  cos2  9  cos  (fr  sin2  (jxfr  sin  9  -  cos3  9  cos2  (fr  sin  9( cos  9  cos  (fr(fr  +  sin  (fr  sin  99)  - 
cos2  #(sin  9  sin  (fr  +  cos2  (fr)7 

b  cos3  #cos2  ^  sin  ^0  + cos2  #cos2  </>{- cos  9  sin  (jxfr  +  cos  (fr  sin  99) 


V 


cos  #(sin  9  sin  (fr  +  cos  (fr) 


V 


®(3,7)  =  //v  Components  of  [®]{#}(3,1) 


-  cos  9  cos2  (fr  -  sin  9  cos  9  sin  (frO  +  (cos  9  cos  (fr  sin  9  cos  9  +  sin  9  cos2  9  cos  (j))\j/ 

(sin  9  sin  (fr  +  cos2  (j))1 


0(3,8)  =  Hy  Components  of  [®]{#}(3,1) 


cos  9  cos  (jxj)-smOO  +  (-  cos  9  cos  ^  sin  9+ sin  9)\j/ 
sin  9  sin  (fr  +  cos2  (fr 
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0(3,9 )  =  Hz  Components  of  [O]{0}(3,1) 

-sin  0cos6^-sin0cos00  +  (sin2  0 cos  9  +  sin2  0cos  6)\j/ 
sin  9  sin  ^  +  cos2  $ 
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